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ABSTRACT 


Closed  Form  Guidance  Laws  for  Intercepting 

Moving  Targets 

by 

Christopher  S.  Bartley 


A  family  of  air-to-surface  guidance  laws  designed  to  intercept  moving  targets  has 
been  developed.  They  include  the  effect  of  gravity,  as  well  as  constraints  on  the 
terminal  flight  path  and  heading  angle,  and  are  designed  for  tracking  moving  targets. 
These  guidance  laws  yield  equations  for  the  commanded  accelerations.  They  are  based 
firmly  on  optimal  control  theory  and  meet  the  first  and  second  variation  necessary 
conditions  that  originate  from  Pontryagin’s  Minimum  Principle.  In  addition,  these 
solutions  also  meet  the  second  variation  sufficient  conditions  for  a  minimum.  They 
have  been  evaluated  in  six  degree  of  freedom  simulations.  The  results  show  that  they 
perform  as  designed,  even  for  airframes  which  are  rather  sluggish. 
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Chapter  1 
Introduction 

This  thesis  presents  a  family  of  optimal  guidance  laws  for  air-to-surface  missiles.  This 
work  is  motivated  by  a  need  for  increased  missile  strike  capability  and  the  desire  to 
minimize  the  commanded  accelerations  of  a  missile  on  an  air-to-surface  mission.  This 
need  arises  from  increased  target  maneuver  capability,  the  need  to  constrain  the  mis¬ 
sile  to  meet  certain  parameters  on  impact,  and  the  desire  to  minimize  the  commanded 
accelerations  that  the  missile  must  obtain  thus  maximizing  the  terminal  velocity.  The 
following  paragraphs  discuss  prior  work  in  air-to-surface  missile  guidance  and  intro¬ 
duce  the  optimal  solution  for  the  guidance  of  air-to-surface  missiles. 

Currently  there  exist  many  forms  of  guidance  laws  that  engineers  use  to  solve  the 
missile-target  intercept  problem.  The  options  include  proportional  navigation,  aug¬ 
mented  proportional  navigation,  proportional  navigation  command  guidance,  beam 
rider  guidance,  and  command  to  line-of-sight  guidance.  These  options  can  be  more 
easily  understood  realizing  that  they  all  originate  from  one  of  three  categories.  The 
first  category  is  proportional  navigation.  In  proportional  navigation  the  rate  of  change 
of  the  missile  heading  is  proportional  to  the  rate  of  rotation  of  the  line-of-sight  from 
the  missile  to  the  target  [11].  Naturally  all  of  these  types  of  guidance  assume  com¬ 
plete  knowledge  of  the  target.  The  other  category  is  that  of  line-of-sight  guidance.  In 
line-of-sight  guidance  the  line-of-sight  originates  from  an  observer  not  on  the  missile. 
The  observer  faces  directly  toward  the  target  forming  the  line-of-sight.  The  missile 
is  ordinarily  fired  from  the  observer  position  and  the  missile  steering  commands  are 
proportional  to  the  angle  of  the  missile  off  the  line-of-sight  [11].  In  line-of-sight  guid¬ 
ance  there  is  no  consideration  for  the  velocity  of  the  target  and  therefore  the  missile 
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will  not  orient  itself  to  lead  the  target  by  a  certain  distance  in  order  to  anticipate 
its  movement.  The  missile  simply  follows  the  line-of-sight  exactly  and  thus  will  need 
to  have  greater  maneuvering  capability  in  order  to  intercept  a  maneuvering  target 
than  is  needed  in  proportional  navigation.  Line-of-sight  guidance  is  typically  used 
for  short-range  intercepts.  The  third  category  of  guidance  is  called  pursuit  guidance. 
In  pursuit  guidance  typically  a  missileborne  tracker  is  assumed  which  will  be  used 
to  lock  on  to  the  target.  The  only  difference  in  pursuit  guidance  and  line-of-sight 
guidance  is  that  in  line-of-sight  guidance  the  observer  who  supplies  the  missile  with 
target  information  is  not  attached  to  the  missile.  In  pursuit  guidance  this  observer 
is  attached  to  the  missile  itself  and  therefore  there  is  no  third-party  observer.  Also, 
pursuit  guidance  doesn’t  anticipate  the  targets  movement  and  simply  orients  itself 
directly  at  the  target  at  all  times  [11]. 

The  first  missile  to  use  proportional  navigation  was  the  Lark  missile,  which  suc¬ 
cessfully  intercepted  its  first  target  in  December  of  1950.  Since  that  time  proportional 
navigation  guidance  has  been  used  in  virtually  all  of  the  world’s  tactical  radar,  in¬ 
frared  (IR),  and  television  (TV)  guided  missiles  [16].  The  proportional  navigation 
law  yields  commanded  accelerations  that  are  perpendicular  to  a  line  of  sight  vector 
between  the  missile  and  the  target.  The  commands  are  proportional  to  the  rota¬ 
tional  rate  of  the  line-of-sight  and  the  closing  velocity  [21].  The  guidance  law  can  be 
expressed  as 

ne  =  N'VcX  (1.1) 

where  ric  is  the  commanded  acceleration,  N'  is  the  effective  navigation  ratio  (usually 
3-5),  Vc  is  the  closing  velocity,  and  A  is  the  rotational  rate  of  the  line  of  sight  vector. 
In  order  to  understand  proportional  navigation  consider  Figure  1.1.  This  figure  rep¬ 
resents  an  inertial  coordinate  system  fixed  to  the  surface  of  a  flat-Earth  model  (i.e., 
the  X  axis  is  downrange  and  the  y  axis  can  either  be  altitude  or  crossrange).  Using 
this  coordinate  frame  it  is  possible  to  integrate  components  of  the  accelerations  and 
velocities  in  terms  of  x  and  y  directions  without  having  to  consider  the  extra  terms 
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Figure  1.1:  Two-dimensional  missile-target  engagement  geometry  [21] 

due  to  the  Coriolis  effect.  The  missile  and  target  travel  at  constant  velocity  and  the 
effects  of  drag  and  gravity  are  neglected.  In  the  figure  the  velocity  of  the  missile  is 
denoted  by  the  vector  Vm  as  the  target  velocity  is  characterized  by  the  vector  Vt-  The 
range  Rtm  is  the  distance  down  the  line  of  sight  separating  the  missile  and  the  target. 
The  commanded  acceleration  of  the  missile  ric  is  perpendicular  to  the  instantaneous 
line  of  sight  and  the  target  acceleration  nr  is  perpendicular  to  the  target  velocity  Vy. 
The  angle  A  represents  the  angle  between  the  horizontal  and  the  line  of  sight  vector 
and  represents  the  flight  path  angle  of  the  target.  Now  it  is  possible  to  see  from 
the  figure  that  the  missile  is  moving  with  a  velocity  magnitude  Vm  at  an  angle  9  +  (j). 
6  is  known  as  the  missile  lead  angle  which  is  theoretically  the  correct  angle  for  the 
missile  to  be  on  a  collision  triangle  with  the  target.  In  other  words,  if  the  missile  is 
on  a  collision  triangle,  no  further  acceleration  commands  are  required  for  the  missile 
to  hit  the  target  [21].  The  angle  (j)  is  known  as  the  heading  error  and  denotes  the 
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initial  deviation  of  the  missile  from  the  collision  triangle.  It  is  desired  to  make  the 
magnitude  of  the  line  of  sight  vector  Rtm  approach  zero  where  target  interception 
would  occur.  The  closing  velocity  Vc  is  defined  as  follows 

Vc  =  —Rtm-  (1-2) 

It  is  possible  to  see  that  the  closing  velocity  Vc  will  be  zero  when  the  magnitude  of 
the  line  of  sight  vector  Rtm  is  at  a  minimum.  The  rate  of  rotation  of  the  line  of  sight 
vector  can  be  obtained  as  follows 

;  Rtmi^tmi  —  RtmtVtmi 


^M 


(1.3) 


Now  by  using  the  equation  for  the  closing  velocity  Vc  and  the  rotational  rate  of  the 
line  of  sight  vector  A  it  is  possible  to  determine  the  commanded  acceleration  Uc- 
Depending  on  the  capabilities  of  the  missile  being  used,  the  effective  navigation  ratio 
will  range  from  a  minimum  of  three  to  a  maximum  of  five  [21].  Keep  in  mind  that 
the  effective  navigation  ratio  is  an  indication  of  the  overall  capability  of  the  missile 
that  is  being  used  to  track  the  target  and  relates  directly  to  the  acceleration  and 
sensor  capabilities  of  the  missile.  If  the  effective  navigation  ratio  is  three,  it  means 
that  the  missile  must  be  able  to  accelerate  at  three  times  the  magnitude  of  the  target. 
Proportional  navigation  does  not  take  the  effects  of  gravity  into  account,  the  time  to 
target  is  merely  an  estimation,  and  it  is  not  an  optimal  guidance  law  that  minimizes 
either  the  total  flight  time  or  the  commanded  acceleration. 

Augmented  proportional  navigation  is  another  guidance  law  used  in  today’s  missile 
technology.  Augmented  proportional  navigation  is  proportional  navigation  with  an 
extra  term  to  account  for  a  maneuvering  target  [16].  The  equation  to  calculate  the 
commanded  accelerations  for  the  missile  using  augmented  proportional  navigation  is 
as  follows 


Uc  =  N'VcX  + 


N' Tlx 


(1.4) 


where  nx  is  the  acceleration  of  the  target.  Prom  the  analysis  performed  in  [21]  it 
is  possible  to  see  that  the  required  missile  acceleration  decreases  monotonically  with 
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time,  regardless  of  the  effective  navigation  ratio,  rather  than  increasing  monotonically 
with  time  as  was  the  case  with  proportional  navigation.  Also,  it  is  possible  to  see  that 
the  augmented  proportional  navigation  approach  requires  less  overall  acceleration  of 
the  missile  than  the  traditional  proportional  navigation  approach.  However,  for  an 
effective  navigation  ratio  of  five  the  maximum  required  acceleration  for  augmented 
proportional  navigation  is  higher  than  the  maximum  required  acceleration  for  pro¬ 
portional  navigation.  Experience  has  demonstrated  that  if  the  effective  navigation 
ratio  is  five  the  augmented  proportonal  navigation  technique  requires  less  acceleration 
about  seventy-five  percent  of  the  time  compared  to  proportional  navigation.  Although 
augmented  proportional  navigation  has  many  benefits  over  proportional  navigation 
it  still  does  not  take  into  account  gravity,  the  time  to  target  is  still  merely  an  esti¬ 
mate,  and  although  it  for  the  most  part  requires  less  acceleration  than  proportional 
navigation  it  is  still  not  an  optimal  solution.  Additionally  proportional  navigation 
in  general  was  developed  for  high  velocity  targets  and  has  been  applied  to  station¬ 
ary  surface  targets.  Proportional  navigation  is  not  well  suited  for  the  air-to-surface 
guidance  problem. 

Many  other  guidance  laws  such  as  proportional  navigation  command  guidance, 
beam  rider  guidance,  and  command  to  line-of-sight  guidance  fall  under  the  category 
of  line-of-sight  guidance  systems.  Proportional  navigation  command  guidance,  also 
known  as  a  manual  guided  weapon  system,  implies  that  the  human  operator  has 
the  task  of  tracking  both  the  target  and  the  missile  [9].  Traditionally  proportional 
navigation  is  implemented  in  a  homing  loop.  In  the  homing  loop  all  the  necessary 
information  that  the  missile  needs  to  intercept  the  target  is  obtained  by  a  seeker.  A 
seeker  is  a  device  that  is  fixed  to  the  front  of  the  missile  that  provides  target  position 
and  velocity  information.  When  using  a  seeker  with  proportional  navigation  the 
range  to  the  target  is  not  usually  needed  to  calculate  the  commanded  accelerations. 
In  the  case  when  command  proportional  navigation  is  being  used  the  range  from 
the  missile  to  the  target  is  a  necessary  component.  Since  the  range  from  the  missile 


6 


to  target  tends  toward  zero  as  the  flight  progresses,  the  effective  noise  on  the  line- 
of-sight  angle  will  get  very  large  toward  the  end  of  the  flight.  This  means  that 
command  guidance  systems  generally  have  to  contend  with  more  noise  than  homing 
systems  near  the  end  of  the  flight  [21].  Beam  rider  guidance  systems  use  a  target 
tracker  whose  purpose  is  to  maintain  the  antenna  boresight  pointing  at  the  center  of 
the  reflecting  area  of  the  target.  The  missile  usually  carries  a  sophisticated  receiver 
which  can  detect  the  missile’s  angular  deviation  from  the  center  of  the  beam  [9].  If 
the  beam  is  always  on  the  target  and  the  missile  is  always  on  the  beam,  an  intercept 
will  result.  The  beam  originates  from  someone  on  the  ground  sighting  the  target  as 
displayed  in  Figure  1.2.  The  beam  riding  guidance  principle  is  probably  one  of  the  first 
methods  used  because  of  its  simplicity  and  ease  of  implementation  [21].  Also  beam 
riding  performance  can  be  significantly  improved  by  taking  the  beam  motion  into 
account.  This  is  similar  to  improving  proportional  navigation  by  taking  into  account 
the  target  motion  (augmented  proportional  navigation).  By  taking  into  account  the 
beam  motion  the  acceleration  required  decreases  and  the  accuracy  of  the  intercept 
increases  [21].  Beam  riding  guidance  is  achieved  using  semi-automatic  systems  where 
the  human  operator  only  tracks  the  target  [9].  Figure  1.2  indicates  some  of  the  well 
known  features  of  the  surface-to-air  guided  weapon  system  Rapier  [8]  and  should 
give  some  insight  into  beam  riding  guidance.  It  is  important  to  note  that  none  of  the 
guidance  systems  mentioned  consider  the  effects  of  gravity,  are  merely  able  to  estimate 
the  overall  flight  time,  and  are  not  able  to  minimize  commanded  accelerations  or  final 
flight  times. 

Therefore,  a  need  exists  for  an  optimal  air-to-surface  guidance  law  that  will  take 
the  effects  of  gravity  into  account,  will  allow  the  total  time  to  target  to  be  solved 
analytically,  and  will  minimize  the  commanded  accelerations  or  the  total  flight  path 
time  depending  on  what  is  desired.  The  problem  is  posed  using  Figure  1.3  where  the 
frame  x,  y,  and  z  is  a  reference  frame  fixed  on  the  Earth’s  surface.  Both  the  missile 
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Figure  1.2:  Rapier  -  a  semiautomatic  system  [9] 


Figure  1.3:  Proposed  reference  frame  and  physical  problem  setup 
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and  the  target  velocities  are  denoted  where  it  is  a  velocity  in  the  x  direction,  w  is  a 
velocity  in  the  y  direction,  and  w  represents  a  velocity  in  the  z  direction. 

A  family  of  guidance  laws  has  been  developed  that  takes  gravity  into  account, 
allows  the  time  to  target  to  be  solved  analytically,  and  is  designed  for  air-to-surface 
missiles  tracking  moving  targets.  Additionally  the  analjdic  guidance  laws  allow  op¬ 
tions  to  simply  intercept  the  target  without  terminal  angle  constraints,  to  enforce  a 
terminal  flight  path  angle  constraint,  to  enforce  a  terminal  heading  angle  constraint, 
or  to  constrain  both  as  displayed  in  Figure  1.4.  In  addition  each  guidance  law  has 
the  capability,  if  desired,  to  minimize  the  total  flight  path  time.  These  new  guidance 
laws  commanded  accelerations  are  in  the  x,  y,  and  z  directions.  They  have  been  ob¬ 
tained  using  the  first  variation  necessary  conditions  and  the  transversality  conditions 
from  Pontryagin’s  Minimum  Principle  [10].  In  order  to  ensure  that  they  are  indeed 
optimal  it  is  necessary  to  ensure  that  they  not  only  meet  the  first  variation  necessary 
conditions  for  a  minimum  but  also  the  second  variation  suflicient  conditions  for  a 
minimum.  In  optimal  control  theory  the  first  variation  necessary  conditions  confirm 
that  the  solution  is  indeed  capable  of  being  a  minimum,  but  is  not  necessarily  a  min¬ 
imum.  All  minimizing  solutions  will  satisfy  the  first  and  second  variation  necessary 
conditions.  The  second  variation  suflicient  conditions,  if  met,  will  confirm  that  the 
solution  is  indeed  a  minimum.  Although  the  necessary  conditions  were  used  to  derive 
the  guidance  laws,  and  the  necessary  conditions  were  satisfied,  it  is  possible  that  the 
guidance  laws  are  still  not  minima  (they  could  be  a  saddle  point).  The  second  varia¬ 
tion  sufficient  conditions  unambiguously  verify  the  minimality  of  the  solutions.  All  of 
the  guidance  laws  in  this  thesis  satisfy  the  first  and  second  variation  necessary  con¬ 
ditions  and  the  second  variation  sufficient  conditions  for  a  minimum.  A  consequence 
of  these  guidance  laws  is  reduced  actuator  usage,  while  achieving  maximum  terminal 
velocity  by  minimizing  commanded  acceleration  which  reduces  drag.  Also,  these  laws 
can  minimize  the  total  flight  time  which  gives  maximum  capability  to  the  missile 
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X  X 


Flight  Path  Angle  Heading  Angle 

Figure  1.4:  Defined  flight  path  angle  and  heading  angle 


when  intercept  time  is  an  important  factor.  These  new  solutions  provide  numerous 
options  and  capabilities  that  were  not  previously  available. 

In  Chapter  2  the  guidance  laws  are  developed  using  the  first  variation  conditions 
that  arise  out  of  Pontryagin’s  Minimum  Principle.  These  conditions  state  that  the 
solution  is  a  minimum,  maximum,  or  a  saddle  point.  Later  these  conditions  are  used 
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to  also  verify  the  optimality  of  the  solution  in  Chapter  5.  Chapter  3  considers  the 
second  variation  necessary  conditions  and  demonstrates  that  the  guidance  laws  do 
indeed  meet  these  conditions.  The  second  variation  necessary  conditions  rule  out  the 
possibility  that  the  candidate  solution  is  a  maximum,  but  do  not  ensure  that  it  is  a 
Tninimunn-  Chapter  4  considers  the  second  variation  sufficient  conditions.  The  second 
variation  sufficient  conditions  prove  that  the  solution  being  considered  is  indeed  a 
minimum.  In  Chapter  5  the  first  variation  conditions  are  used  to  verify  that  the 
family  of  guidance  laws  that  were  derived  are  indeed  correct.  Next  it  is  shown  that 
the  analytic  guidance  laws  meet  the  second  variation  sufficient  conditions.  Also, 
an  optimization  tool  known  as  DIDO  is  used  to  determine  the  numerically  optimal 
trajectories  given  certain  conditions  and  can  be  compared  with  the  analytic  guidance 
laws.  Also,  the  guidance  laws  are  incorporated  into  and  tested  in  an  existing  6-DOF 
missile  simulation.  The  guidance  laws  performed  extremely  well  when  implemented 
into  this  missile  simulation.  Chapter  6  reviews  the  derivations  and  analysis  performed 
and  then  draws  conclusions  about  the  family  of  guidance  laws  based  on  these  findings. 
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Chapter  2 

First  Variation  Necessary  Conditions 

In  order  to  derive  optimal  control  guidance  laws  there  must  first  exist  a  foundation 
upon  which  they  are  to  be  built.  Therefore  it  is  necessary  to  derive  a  set  of  first  order 
necessary  conditions  that  must  be  satisfied  in  order  to  obtain  an  optimal  solution 
[10].  Given  the  performance  index,  which  is  to  be  minimized,  of  the  form 

J  =  E{xf,tf)+  f  F{x,y,T)dT  (2.1) 

Jto 

subject  to  the  following  dynamics 

x  =  f{x,u,t)  x{to)  =  Xo  (2.2) 

with  the  terminal  conditions 

e{xf,tf)  =  0  (2.3) 

the  constraints  are  adjoined  to  the  performance  index  with  Lagrange  multipliers 

J' =  G{xf,tf,u)  +  f  H{x,u,\,t)  —  X'^x  dr  (2-4) 

Jto 

where  the  Hamiltonian  and  Bolza  function  are 

H{x,u,X,t)  =  F{x,u,t)  +  X'^  f(x,u,t)  (2.5) 

Gixf,tf,u)  =  E{xf,tf)  +  u^e{xf,tf).  (2.6) 

Taking  variations,  the  adjoined  performance  index  becomes 

SJ^  =  GxfSxf  +  GffStf  +  GiySu  +  {[H{xj  u,  A,  t)  X^x]5t}^-/^ 

+  /  Hjx-\-Hju-¥Hx5X-5X^x-X^5xdT. 

Jto 


(2.7) 
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The  above  variation  references  Leibnitz’s  rule  with  regard  to  taking  variations  of  an 
integral  I,  if 

1=  [  F(z(r),r)dr  (2.8) 

Jto 


the  variation  of  I  is 

6I  =  [FStf^ti+  rSFSr.  (2.9) 

Jto 

In  addition,  the  relation  between  the  time  fixed  variation  5( )  and  the  time  free 
variation  5( )  is 


)  =  ^(  )  +  (>"• 


(2.10) 


Recalling  that  =  e  =  0  and  Hx  =  f{x,u,t)  and  [/(x,u,r)  -  i;]5A  =  0,  it  follows 
that 

6J'  =  G,^Sxf  +  GtfStf  +  {[H{x,u,X,t)-X'^my£ti 
rh 

+  /  hJx  +  Hu5u-  X'^SxdT.  (2.11) 

Jto 

Since  to  is  specified,  Stg  =  0.  Also,  Sxf  is 

Sxf  =  Sxf  —  XfStf.  (2.12) 

Now  using  integration  by  parts  the  third  term  in  the  integral  simplifies  to 


f  X^6x  dr  =  —  f  X^5x  dr 

j  to  J  to 

.  _  r^f .  ~ 

=  XjSxf—  X^Sxdr. 

Jto 

Now  the  first  variation  of  the  adjoined  performance  index  becomes 


SJ'  =  {G^^-X'^)Sxf  +  iGtf  +  Hf)5tf 
+  /  {HxSx  +  A^)(5x  +  HjtSu  dr. 

Jto 


(2.13) 

(2.14) 


(2.15) 


Up  to  this  point  nothing  has  been  said  about  the  Lagrange  multipliers  or  costates, 
A.  They  are  now  chosen  such  that  the  coefficients  of  the  dependent  variations,  5x, 
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vanish.  Therefore  eliminating  all  but  the  independent  variations,  the  first  variation 
is 

5J'  =  +  Hf)Stf  +  /  HJu  dr  (2.16) 

Jto 

with 

X  =  -H^  and  Xf  =  Gl^.  (2.17) 

Finally,  the  coefficients  of  Su  and  Stf,  the  independent  variations,  must  vanish  for  the 
first  variation  to  vanish,  thus 

Hu  =  0  and  Hf  =  -Gtf.  (2.18) 

Therefore  the  first  variation  necessary  conditions  (the  Euler-Lagrange  equations) 


are 

A  =  -H^{x,u,X,t)  (2.19) 

X  =  f{x,u,t)  Xo  =  x{to)  (2.20) 

=  0  (2.21) 

with  the  transversality  conditions 

Xf  =  Gl  (2.22) 

Hf  =  -Gt,  (2.23) 

e{xf,tf)  =  0.  (2.24) 


These  necessary  conditions  fall  out  of  Pontryagin’s  Minimum  Principle. 

By  taking  the  total  derivative  with  respect  to  time  of  the  Hamiltonian  a  useful 


H  =  H{x,u,t,X) 

dt  dt  ^  dx  dt  du  dt  dX  dt 


(2.25) 

(2.26) 


result  appears 
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If  the  Hamiltonian  is  not  explicitly  a  function  of  time,  ^  =  0.  Also,  based  on  the  first 
variation  necessary  conditions  Hu  =  0.  Notice  that  ^  =  —A  and  ^  =  x.  Therefore 

dH  _  dHdX 

dt  dx  dt  dX  dt 
=  —X^x  4-  iFX  =  0. 


(2.27) 

(2.28) 


From  the  transversality  conditions 

H  =  constant  =  —Gtf  (2.29) 

Now  not  only  is  Hf  equal  to  —Gtj  but  the  Hamiltonian  at  every  point  in  time  is 
equal  to  —Gtj.  This  result  gives  an  excellent  condition  that  can  be  used  to  determine 
if  the  necessary  conditions  for  a  minimum  are  met  at  every  instance  in  time,  if  the 
Hamiltonian  is  not  an  explicit  function  of  time. 


2.1  Dynamics  of  the  System 

The  equations  of  motion  in  Cartesian  coordinates  are: 


(2.30) 

(2.31) 


z  =  w  (2.32) 

u  =  ttx  (2.33) 

V  =  tty  (2-34) 

w  =  az  +  g  (2.35) 


X  refers  to  the  downrange  position  of  the  vehicle,  y  refers  to  the  crossrange  position 
of  the  vehicle,  2:  is  the  altitude  of  the  vehicle,  u  is  the  downrange  velocity,  v  is  the 
crossrange  velocity,  w  is  the  vertical  velocity,  ax  is  the  downrange  acceleration,  ay 
is  the  crossrange  acceleration,  and  az  is  the  vertical  acceleration.  In  addition  the 


constraints  are  as  follows 
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Xf  =  XT  —  uritj  —  t) 

(2.36) 

Vf  =  Vt  -  vritf  —  t) 

(2.37) 

Zf  =  Zt  —  writf  —  t) 

(2.38) 

where  the  subscript  T  refers  to  the  target. 

2.2  Three  Dimensional  Moving  Target  with  no 

Additional  Constraints 

2.2.1  The  Performance  Index  and  Problem  Set-up 

This  performance  index  is  posed  as 

min  J  =  rt/  +  i  [  \l  +  al  +  aldT  (2.39) 

2  Jto 

subject  to  the  aforementioned  dynamics  Eqns.  2.30-2.35,  with  a  specified  initial  state 
Xo,  Vo,  Zo,  Uo,  Vo,  and  Wg.  The  following  enforced  terminal  constraints  are 

Cx  =  Xf  —  xt  +  uxitf  —  t)=0  (2.40) 

~  Vf  ~  yT  +  vxitf  —  t)  =  0  (2-41) 

=  Zf  —  zt  +  WT{tf  —  t)  =  0.  (2.42) 

where  the  subscript  T  annotates  the  state  of  the  target.  F  is  a  weighting  parameter 
on  the  final  time  (if  it  is  unspecified).  This  is  a  trade-off  between  the  minimum  time 
problem  and  the  minimum  control  effort  problem.  Normally  F  is  set  to  zero  in  order 
to  minimize  the  commanded  acceleration.  Increasing  F  to  a  large  number  has  the 
effect  of  finding  a  minimum  time  trajectory.  The  Hamiltonian  and  the  Bolza  function 
are 

H  =  n  (®x  "b  "b  "b  A^Ox  "b  At,fly  -j-  Au,(ttx  -|-  p)  (2.43) 

=  Ttf  -H  l/x^x  +  "b  I'z^z-  (2.44) 


G 
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2.2.2  The  First  Variation  Conditions 

The  Pontryagin  Minimum  Principle,  along  with  the  transversality  condition  on  the 
final  state,  yield  the  following  equations 


=  0 

(2.45) 

\y 

=  0 

(2.46) 

K 

=  0 

(2.47) 

—  Ajj 

(2.48) 

\y 

=  —Xy 

(2.49) 

=  -A, 

(2.50) 

with  the  terminal  conditions 


Axy 

=  t'x 

(2.51) 

= 

(2.52) 

= 

(2.53) 

^Uf 

=  0 

(2.54) 

^Vf 

=  0 

(2.55) 

^Wf 

=  0 

(2.56) 

"tgo  —  t 


If  we  define 


(2.57) 
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the  Lagrange  multipliers  are  found  to  be 

Ajj  — 

(2.58) 

Xy  = 

^y 

(2.59) 

A,  = 

(2.60) 

Alt  — 

^x^go 

(2.61) 

Xy  — 

^ytgo 

(2.62) 

Xy)  — 

^ztgo 

(2.63) 

and  the  controls  Ux,  a^,  obtained  from  the  Euler  Lagrange  equations,  are 

0/x  —  Ay 

—  ^x^go 

(2.64) 

Ciy  -  Xy 

=  —I'ytgo 

(2.65) 

dz  —  A^ 

—  ^ztgo' 

(2.66) 

The  states  can  now  be  written  as 

X  =  Uftgo  + Xt +  UTtgo 

(2.67) 

^y^go  . 

y  —  g  '^f^go 

+  yT  +  Vxtgo 

(2.68) 

„  _  ^2*90 

6  2 

—  Wftgo  +  Zx  +  WTtgo 

(2.69) 

U  =  2 

(2.70) 

^  =  2 

(2.71) 

W  =  2 

(2.72) 

The  states  in  the  x,  y,  and  z  directions  are  all  independent  of  each  other  as 

well  as 

their  associated  controls  a^,  ay,  and  Uz.  Solving  for  the  Lagrange  multipliers  in  terms 
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of  the  states  yields 


I'x  = 


i',,  = 


3{u  —  ut)  3(a;  —  Xt) 

a?  tt^ 

3(w-'yT)  Hy-yr) 

o  • 


3(w;  —  wt)  3(2;  —  zt) 


and  the  controls  can  be  expressed  as 


Oix 

Qy 


-—{x-xt  +  tgo{u  -  Ut)) 
^90 


3 

^90 

3 

-— (2;  -  Zr  +  tgo{w  -  Wt)) 
^90 


% 

2 


The  acceleration  can  compactly  be  written  as 


a  =  -^(vtpo  +  r)  -  ^ 


where 


A 

r  = 


Xy  Xt 

yv-yr 


Zv-Zt 


A 

V  = 


uv  —  Ut 

Vy  —  Vt 


[  Wy  —  Wt 

g  =  [0  0  gf. 


(2.73) 

(2.74) 

(2.75) 


(2.76) 

(2.77) 

(2.78) 


(2.79) 


(2.80) 


(2.81) 

(2.82) 


Thus,  a  closed-loop  feedback  guidance  law  which  is  dependent  only  on  the  current 
state,  the  terminal  state,  and  the  time  to  target  has  been  obtained.  The  variational 
method  was  used  because  it  allows  for  a  solution  of  the  final  time. 
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2.2.3  Solving  for  the  Final  Time 

The  transversality  condition  from  the  Pontryagin  Minimum  Principle  associated  with 
the  free  final  time  condition  {Hf  =  -Gtp)  results  in  the  following  equation 

+  A„aa;  +  A^Cj,  +  +  9)  =  -Gtj  (2.83) 

where 

-Gtf  =  -P  +  Vj:Ut  +  VyVT  +  VzWt-  (2.84) 

A  useful  condition  is  obtained  from  the  first  integral  (being  a  constant),  since  the 
Hamiltonian  is  independent  of  time,  which  can  be  expressed  as 

=  -^(a^  +  +  a^)  +  ViM  +  VyV  +  UzW  +  X^g  (2.85) 

and  after  combining  the  Hamiltonian  and  the  Bolza  function  the  following  result  can 
be  expressed. 

0  =  (2r  +  •  g)tJo  -  3(v  •  V  +  r  •  g)t^o  -  12(v  •  r)tgo  -  9(r  •  r)  (2.86) 

In  most  cases  it  is  desired  to  minimize  the  commanded  acceleration  and  thus  P  should 
be  set  to  zero.  However  if  it  is  desired  to  minimize  the  flight  time,  then  P  would  be 
set  to  a  large  positive  number. 

2.2.4  The  Analytic  Solution  for  tgo 

The  equation  for  tgo  can  be  solved  analytically  [7].  First  the  equation  begins  in  the 
form  noted  in  the  previous  section. 

+  Gt^go  +  Dtgo  +  E  =  0  (2.87) 

After  dividing  through  by  A  the  equation  becomes 


tl  +  B'tl,+Ctl,  +  D't,,  +  E'  =  0. 


(2.88) 
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Translate  the  equation  such  that  the  cubic  term  is  eliminated  therefore 


+  Py^  +  Qy  +  i?  =  0 

(2.89) 

where 

p  =  6h2  +  3B'h  +  C" 

(2.90) 

Q  =  +  35  V  +  2C'h  +  P' 

(2.91) 

R  =  /i^  +  5V  +  C7V  +  5'/i  +  5' 

(2.92) 

with 

X  =  y  +  h 

(2.93) 

and 

h 

(2.94) 

Next  obtain  the  cubic  resolvent 

+  2Ft2  +  (P^  -  45)t  -  =  0 

(2.95) 

or 

“b  OiZ  “b  6  =  0 

(2.96) 

where 

a  =  i[3(P'*  -  4P)  -  4P2] 

O 

(2.97) 

b  =  ^[16P^  -  18P(P2  -  4P)  -  27Q2] 

Z  i 

(2.98) 

with 

Z  =  t  —  s 

(2.99) 

*  =  -1^- 

(2.100) 

Next  calculate  (A) 

as 

A  ft" 

^=27+4- 

(2.101) 
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If  A  >  0,  solve  the  resolvent  by  the  Cardan  formula  so  that  the  roots  are 

Zi  =  ~ 

Z2  =  complex 
Z3  =  complex. 


(2.102) 

(2.103) 

(2.104) 


If  A  =  0,  the  roots  of  the  resolvent  are 


= 

Z2  = 
Z3  = 


(2.105) 

(2.106) 
(2.107) 


If  A  <  0,  the  resolvant  is  solved  using  the  trigonometric  technique.  Therefore 


Zi  =  Eo  cos{^) 

Z2  =  £;,cos(^  +  120°) 
Z3  =  Eocos(^  +  240°) 

where 


and  the  angle  (j)  is  defined  by 

cos{<f>)  =  — 

2 

sin(0)  =  +\/l  —  cos2(0) 

According  to  the  sign  of  A,  the  critical  root  of  the  cubic  resolvent  is 


(2.108) 

(2.109) 

(2.110) 


(2.111) 


(2.112) 

(2.113) 


R'  =  max  [realroots(Zi  +  s,  .^2  +  s,  Z3  +  s)]. 


(2.114) 
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A  positive  real  root  will  always  be  found.  Now  that  B!  is  obtained,  the  parameters  ^ 
and  P  can  be  obtained  from 

P  =li,P  +  R  + -^)  (2.116) 

Knowing  ^  and  the  factorization  of  Eq.  4.58  is 

(y'‘  +  VRy  +  (){¥‘-s/^y  +  ff)  =  0.  (2.117) 

The  solution  of  the  two  quadratics  yields  the  yi{i  =  1,4)  of  Eq.  4.58.  Therefore  the 
roots  of  Eq.  4.56  are 

Xi  =  yi  +  h,  i  =  1, . . . ,  4.  (2.118) 

2.3  Three  Dimensional  Moving  Target  with  a  Constraint 

on  Final  Flight  Path  Angle 

2.3.1  The  Performance  Index  and  Problem  Set-up 

This  minimum  control  effort  (acceleration)  problem  can  be  posed  as 

min  J  =  r  tf  +  ^  f  al  +  tty  +  aldr  (2.119) 

subject  to  the  aforementioned  dynamics  Eqns.  2.30-2.35,  with  a  specified  initial  state 
Vo,  ^o,  Uo,  Vo,  and  Wo-  The  following  terminal  constraints  will  also  be  enforced 


Ca;  =  Xf-XT  +  UT{tf  -  t) 

(2.120) 

—  yf-yT  +  Vritf  - 1) 

(2.121) 

ez  =  Zf  -  zr  +  writf  -t) 

(2.122) 

64  =  Wf  —  Ufta.n'yf. 

(2.123) 

Again,  F  is  a  weighting  parameter  on  the  final  time  (if  it 

is  unspecified),  and  can  be 

used  for  a  minimum  time  problem.  The  Hamiltonian  and  the  Bolza  function  for  the 
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case  of  a  three  dimensional  moving  target  with  a  constraint  on  the  final  flight  path 
angle  are 

H  —  n  (flj  +  fly  +  fl^)  +  Axtl  +  XyV  +  XzW  +  Xuttx  "I"  Xytty 

+Xyj(az  +  g)  (2.124) 

G  =  rt/ + 1/3:63;  +  i/yCy  +  i/^e^  + 1/464.  (2.125) 

2.3.2  The  First  Variation  Conditions 

The  Pontryagin  Minimum  Principle,  along  with  the  transversality  condition  on  the 
final  state,  yield  the  following  equations 


=  0 

(2.126) 

\y 

=  0 

(2.127) 

K 

=  0 

(2.128) 

Ay 

-  Aj; 

(2.129) 

\i} 

=  —Ay 

(2.130) 

A^y 

=  -A, 

(2.131) 

with  the  terminal  conditions 


Ax/ 

=  Vx 

(2.132) 

Ay/ 

= 

(2.133) 

A., 

=  I'z 

(2.134) 

^Uf 

=  —1/4  tan  7/ 

(2.135) 

^Vf 

=  0 

(2.136) 

^Wf 

=  1/4 

(2.137) 

If  we  define 

tgo  =  tf-t  (2.138) 
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the  Lagrange  multipliers  are  found  to  be 


II 

(2.139) 

II 

(2.140) 

Az  =  I'z 

(2.141) 

(2.142) 

A<y  —  ^y^go 

(2.143) 

\yj  =  ^z^go  ^4 

(2.144) 

and  the  controls  ax,  ay, 

and  a^,  again  derived  from  the  Euler  Lagrange  equations,  are 

Qx  “  Xy^  =  ^x^go  “i” 

(2.145) 

CLy  —  Xy  ^  ^y^go 

(2.146) 

CLz  “  A-y;  ^  ^z^go  ^4’ 

(2.147) 

The  states  can  be  written  as 

X  = 

tan  7/^2^  +  ^  _L  + 

+  Uftgo  +  xt  +  urtgo 

u  L 

(2.148) 

y  = 

1/ 

g®  Vftgo  +  yT  +  Vrtgo 

(2.149) 

>2;  = 

^ztlo  ,  ,  9*%  .  ,  ,  . 

6  +  2  +  2  ^fho  +  ^  +  wrtgo 

(2.150) 

U  = 

Vxt^o 

^  p^idiXi^ftgo  +  Uf 

(2.151) 

V  = 

^y^go  , 

2 

(2.152) 

w  = 

Pz^ 

^  +  V^tgo  +  Wf-  gtgo 

(2.153) 

The  states  in  the  x,  y,  and  z  directions  are  all  independent  of  each  other  as  well  as 

their  associated  controls  ax,  ay,  and  a^.  Solving  for  the  Lagrange  multipliers  in  terms 
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of  the  states  yields 


where 


3q!2  ,  3ai  —  2  ,  2u 

•'go  •'go  •'go 

1  ,  2u 

^ 

t'po  ^go 

3q!2  ,  3q!3-2  ,210  2g 

u,  = 

^go  ^go  ^go  ^90 


Q!i  =  1+  sin^  7/ 
012  =  sin  7/  cos  7/ 
0:3  =  1  +  cos^  7/ 
and  the  controls  can  be  expressed  as 


where 


and  finally 


<^1  ^2  , 

ttx  =  — — «  +  —w  -  — 


2u 


t 


go 

1 


90 


t 


go 


ay  =  -—{v'  +  2v) 


^90 


Q!3  ,  ,  0:2  ,  2{w  +  gtgo) 


a,  = - w  +  —u  — 


t'go 


^90 


^go 


,  ,  3ar  3x7’ 

u  =  «  H - OUT 

tgo  tgo 

,  ,  3y  3?/t  o„ 

U  =  V  -\ - OVt 

igo  tgo 

I  3z  3Zt  ^  gtgo 

w'  =  w  +  - - - - 3wt - ^ 

T'go  ^go  " 


g  =  -32.174^. 

sec^ 


(2.154) 

(2.155) 

(2.156) 

(2.157) 

(2.158) 

(2.159) 

(2.160) 
(2.161) 
(2.162) 

(2.163) 

(2.164) 

(2.165) 

(2.166) 


2.3.3  Solving  for  the  Final  Time 

The  transversality  condition  from  the  Pontryagin  Minimum  Principle  associated  with 
the  free  final  time  condition  {Hf  =  -Gtp)  results  in  the  following  equation 

— (a^  +  +  o^)  +  XxU  +  XyV  +  XgW  +  Xy^Ux  +  X^ay  +  X2{az  +  p)  =  (2.167) 
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where 


—Gtf  =  — r  + 


(2.168) 


A  more  useful  condition  is  obtained  from  the  first  integral  (being  a  constant),  since 
the  Hamiltonian  is  independent  of  time,  which  can  be  expressed  as 


{al  +  al  +  al)  +  u^u  +  VyV  +  +  \^g 


(2.169) 


and  after  combining  the  Hamiltonian  and  the  Bolza  function  the  following  result  can 
be  expressed. 


0  =  +  G^t^gg  +  C2t^go  +  Gltgo  +  Co 


(2.170) 
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where 

C4  =  «"(j-|)  +  r  (2.171) 

Cs  =0  (2.172) 

C2  =  (fei  -  cos^  7/)it^  +  (i>2  -  +  (63  -  sin^  7/)w^  + 

3 

+3p[-63(2;  -  zt)  +  hix  -  xt)  +  69(^  -  zr)  -  2^6(a;  -  xt)] 

+9[biu^  +  b2V^  +  bzw^  +  Sb^UTWr] 

-(661  -  3cos^7/)iiTM  -  (662  -  3)vtv  -  (663  -  3  sin^  7/)«;tiu 

—Qb^WTU  —  Qb^wux  +  Sa2{w  —  Zwt)ut  —  2uut 

— (3q;i  —  2){u  —  3u'J’)ut  —  {v  —  3vt)vt  ~  2vvx 

+3q;2(w  —  3ut)wt  —  (3q!3  —  2){w  —  3wt)wt  —  2wwt  (2.173) 

Cl  =  9[bi{—2xuT  +  2xtUt)  +  b2{—2yvT  +  2yTV'r)  +  b3{—2zwT  +  ^ztWt) 
+366( — xwx  +  Xj’tuj’  —  zuj'  +  2;j''Ux)]  "t"  (6&1  3cos^  T/)(^  xj'^u 
+(662  -  3)  (y  -  yT)v  +  (663  -  3  sin^  7/)  {z  -  zt)w 
+666(-z  —  zt)u  +  6be{x  —  xt)w  +  3a2{3z  —  3zt)ut 
— (3q:i  —  2)(3a:  —  3xt)ut  —  {3y  —  3yT)vT  +  3ot2{3x  —  3xt)wt 
-(303  -  2)(3z  -  3zr)wT  (2.174) 

Co  =  9[6i  (x^  -  2xxt  +  xy)  +  62  {y^  -  2yyT  +  Vt) 

b3{z^  —  2zzt  +  Zx) 3bo{xz  —  xzt  -  zxt  +  xtZt)]  (2.175) 


bi 

3  cos^  7/  —  4 

2 

(2.176) 

1 

“  “2 

(2.177) 

63 

3  sin^  7/  —  4 

2 

(2.178) 

bo 

=  sin  7/ cos  7/ 

(2.179) 

&9 

=  sin^7/  — 2. 

(2.180) 
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2.4  Three  Dimensional  Moving  Target  with  a  Constraint 
on  Final  Heading  Angle 
2.4.1  The  Performance  Index  and  Problem  Set-up 

This  minimum  control  effort  (acceleration)  problem  can  be  posed  as 

mmJ  =  rtf  +  l  r  al  +  al  +  a\  dr  (2.181) 

2  Jto 

with  a  specified  initial  state  Xg.,  Vo,  Zg,  Ug,  Vg,  and  Wg.  The  following  terminal  con- 


straints  will  also  be  enforced 

Cx  =  Xf  -xt  +  Uritf  - 1) 

(2.182) 

^y  =  Vf  -VT  +  vritf  -t) 

(2.183) 

€-z  =  Zf-  Zq'-v  writf  -  t) 

(2.184) 

64  =  Vf  —  Uftanxf- 

(2.185) 

r  is  a  weighting  parameter  on  the  final  time  (if  it  is  unspecified).  This  is  a  trade-off 
between  the  minimum  time  problem  and  the  minimum  control  effort  problem.  The 
Hamiltonian  and  the  Bolza  function  for  this  derivation  are 

H  =  ^(a^  +  +  Kw  +  Xuttx  +  \ay 

A 

“h ^wiflz  “t"  9) 


G  —  1^^/  d"  d”  d~  d”  ^4^4 


(2.186) 

(2.187) 
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2.4.2  The  First  Variation  Conditions 

The  Pontryagin  Minimum  Principle,  along  with  the  transversality  condition  on  the 
final  state,  yield  the  following  equations 


Ax 

Ay 

Az 

Ay 

Ay 

Ay; 

with  the  terminal  conditions 


=  0  (2.188) 


=  0 

(2.189) 

=  0 

(2.190) 

— 

(2.191) 

=  —Ay 

(2.192) 

=  -A, 

(2.193) 

(2.194) 

(2.195) 

Vz 

(2.196) 

—1/4  tan  Xf 

(2.197) 

1/4 

(2.198) 

0. 

(2.199) 

If  we  define 


(2.200) 
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the  Lagrange  multipliers  are  found  to  be 


Az  =  I'z 

Au  —  t^x^go  ^4  tan  'Yj 


Aj; 


—  ^y^go  "h  ^4 
“  ^ztgo 


and  the  controls,  Cx,  Oj,,  are 


dx  —  Ay  —  J^x'^go  d”  ^4 

dy  —  Xy  —  ^y'^go  ^4 

Uz  —  Xyj  —  t/^tgo' 


(2.201) 

(2.202) 

(2.203) 

(2.204) 

(2.205) 

(2.206) 


(2.207) 

(2.208) 
(2.209) 


The  states  can  be  written  as 


X 


y 


z  = 


Uxfgy  _ 

= - ^  - —  -  Uftgo  +  XT  +  urtgo 

D  2 


^yt]o 


90 


Vftgo  +  yT  +  VTtgo 


6  2 
- ^  +  -77-  -  Wftgo  +  Zt  +  WTtgo 


u 

V 

w 


I'xt^ 


90 


^y*lo 


v 


-  i/4tan7/fpo  +  Uf 
+  t^4^go  +  'Vf 

+  Wf—  gtgo- 


(2.210) 

(2.211) 

(2.212) 

(2.213) 

(2.214) 

(2.215) 


The  states  in  the  x,  y,  and  z  directions  are  all  independent  of  each  other  as  well  as 
their  associated  controls  dx,  dy,  and  Oz.  Solving  for  the  Lagrange  multipliers  in  terms 
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of  the  states  yields 


where 


3  3  9  9  6 

— aiM  -  —a2V  +  p-aao:  -  -  -^x 

I'go  ‘'go  ‘'go  ‘'go  ‘‘go 

3  3  9  9  6 

Q!2«  +  -^asv  -  -^a2X  +  -  -^y 

‘'go  ‘'go  ‘'go  ‘'go  ‘'go 

3  .  Z  1  . 

—  (w  +  —  +  -gtgo) 

^go  ^90  ^ 


(2.216) 

(2.217) 

(2.218) 


ai  =  1  +  sin^  Xf 

(2.219) 

a2  =  sin  X/ cos  X/ 

(2.220) 

0:3  =  1  +  cos^  Xf 

(2.221) 

and  the  controls  can  be  expressed  as 


where 


and 


ttl  ,  0-2  ,  2u 

^90  ^go  ^go 

(2.222) 

_  0-2  0:3  2t; 

^go  ^go  tgo 

(2.223) 

3  ,  Z  1  , 

=  -  —  {W+—+-9tgo) 

^go  ^go  ^ 

(2.224) 

,  3x 

u  —  u  +  — 

tgo 

(2.225) 

/  .  3y 

V  =  u  +  — 

^90 

(2.226) 

/  ,  Qtgo 

iv  =  w  + 

Igo  ^ 

(2.227) 

X  =  X  —  xt  —  urtgo 

(2.228) 

y  -  y-yr-VTtgo 

(2.229) 

z  =  z-  zt  -  wrtgo- 

(2.230) 
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2.4.3  Solving  for  the  Final  Time 

The  transversality  condition  from  the  Pontryagin  Minimum  Principle  associated  with 
the  free  final  time  condition  {Hf  =  -Gtp)  results  in  the  following  equation 

hal  +  Oy  +  al)  +  XxU  +  XyV  +  X^w  +  Xutt^  +  A„Oy  +  A2(a^  +  g)  =  -Gtf  (2.231) 

where 

—  Gtj  =  — r  +  +  ^z'^T-  (2.232) 

A  more  useful  condition  is  obtained  from  the  first  integral  (being  a  constant),  since 
the  Hamiltonian  is  independent  of  time,  which  can  be  expressed  as 

//■  =  -i(o^  +  +  a^)  +  Vx^  +  VyV  +  v^w  +  X^g  (2.233) 

Zt 

and  after  combining  the  Hamiltonian  and  the  Bolza  function  the  following  result  can 
be  expressed. 


0  =  Citgg  +  Cstgg  T  ^'2^30  G g  Q  +  ^0 


(2.234) 
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where 


C,  =  j9"  +  2r  (2.235) 

Cs  =  0  (2.236) 

C2  =  -(ai  +  2)u^  -  (0:3  +  2)v^  +  2a2uv  -  Sw^  -  3g{z  -  zt) 

-9(3  sin^  X/  +  l)“r  “  9(3  cos^  Xf  +  l)^r  ~  9u;| 

+54Q!2MTWr  +  \‘2a\UTU  —  12a2VTU  —  \2a2UTV 
■^Vlazvrv  +  \2wtV]  —  6a!i««r  +  &oc2VUt  +  6oi2UVT 
—6CX3VVT  —  6wwt  +  6(3  sin^  Xf  +  1)^t  “  S6a2VTUT 
+6(3  cos^  Xf  +  1)^T  +  (2.237) 

Cl  =  —9(3  sin^  Xf  +  1)(— 2x«r  +  2xtUt)  —  9(3  cos^  %/  +  1)  (”2yuj’  +  2yTVT) 
—9{-2zwt  +  2ztWt)  +  54:a2{-xvT  +  xtVt  —  yur  +  yrur) 

— 12q:i(x  —  X'r)u  +  120:2(2/  ~  +  120:2(2?  —  xt)v  —  120:3(2/  —  2/t)^ 

—12(2:  —  Zt)w  —  6(3  sin^  X/  +  1)(2?  “  xt)ut  +  180:2(2/  —  yT)uT 
+180:2(2:  —  Xt)vt  —  6(3  cos^  Xf  +  l)(y  ~  yT)vT  —  6(2:  —  zt)wt  (2.238) 
Co  =  -9(3  sin^  Xf  +  “  2a;a:r  +  x^)  -  9(3 cos^  Xf  +  l)(y^  -  ‘^Wt  +  Vt) 

-9{z^  -  2zzt  +  2t)  +  540:2(2:2/  —  X2/T  -  y^T  +  XTyr)-  (2.239) 


2.5  Three  Dimensional  Moving  Target  with 
Constraints  on  Final  Heading  Angle 
and  Final  Flight  Path  Angle 
2.5.1  The  Performance  Index  and  Problem  Set-up 


This  minimum  control  effort  (acceleration)  problem  can  be  posed  as 


1 

min  J  =  r  tf  +  -  I  a^  +  ay  +  aldr 
2  Jto 


(2.240) 
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subject  to  the  aforementioned  dynamics  (Eqs.  (3.1)-(3.6)),  with  a  specified  initial 


state  Xo,  Vo,  Zo,  Uo,  u<»  and  Wo- 

enforced 

The  following  terminal  constraints  will 

also  be 

Cx  — 

Xf  —  xt-\-  uritf  -  t) 

(2.241) 

By  = 

2//  —  yr  4-  vritf  —  t) 

(2.242) 

ez  = 

Zf  —  zt  +  writf  —  t) 

(2.243) 

64  = 

Wf  -  It/ tan  7/ 

(2.244) 

65  = 

Wftanxf  —  VfSin'jf. 

(2.245) 

r  is  a  weighting  parameter  on  the  final  time  (if  it  is  unspecified).  This  is  a  trade-off 
between  the  minimum  time  problem  and  the  minimum  control  effort  problem.  The 
Hamiltonian  and  the  Bolza  function  for  this  derivation  are 

H  =  ^{al  +  al  +  al)  +  \xU  H-  \yV  +  X^w  -t-  Xua^  +  XyUy 

+ Au,(o2  +  g)  (2.246) 

G  “  4”  4”  4”  4“  4”  ^^5^5*  (2.24T) 

2.5.2  The  First  Variation  Conditions 

The  Pontryagin  Minimum  Principle,  along  with  the  transversality  condition  on  the 
final  state,  yield  the  following  equations 


=  0 

(2.248) 

Xy 

=  0 

(2.249) 

A. 

=  0 

(2.250) 

Xu 

=  Xx 

(2.251) 

Xy 

=  —Ay 

(2.252) 

Xy) 

=  -A, 

(2.253) 
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with  the  terminal  conditions 


^Xf 

=  Ux 

(2.254) 

Xy/ 

= 

(2.255) 

Xzf 

= 

(2.256) 

Xuf 

(2.257) 

^Vf 

=  -1/5  sin  7/ 

(2.258) 

Xwf 

=  U4  +  U5  tan  Xf 

(2.259) 

If  we  define 

tgo  -  tf  t 

(2.260) 

the  Lagrange  multipliers  are  found  to  be 

Ax  — 

Vx 

(2.261) 

Xy  “ 

(2.262) 

A.  = 

(2.263) 

Xy,  — 

^x^go  ^4  tan  7/ 

(2.264) 

Xy  - 

Uytgo  -  r'5sin7/ 

(2.265) 

Xyj  “ 

Vxtgo  +  +  1^5  tan  Xf 

(2.266) 

and  the  controls,  Ox,  ay,  are 

dx  —  A^j 

=  -Mpo  +  *'4tan7/ 

(2.267) 

CLy  -  A^; 

=  -t'j,tjo  +  *'5sin7/ 

(2.268) 

Cl  2^  -  Xyj 

—  ^z^go  ^4  ^5  tan^^. 

(2.269) 
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The  states  can  be  written  as 


X  = 

i/4tan7/t2^  .  ^  . 

g  +  2  aftgo  +  xt  UTtgo 

(2.270) 

y  = 

Uytl.  Us  sin  7/t^. 

g  +  2  Vftgo  +  yx  +  vrtgo 

(2.271) 

Z  = 

J'ztlo  U4t%  Us  tan  Xft%  ^  ^ 

Q  2  2  2  ''^ftgo  +  ^T  +  WTtgo 

(2.272) 

u  = 

Uxt^o 

^  u^tan'fftgo  +  Uf 

(2.273) 

V  = 

y  Ussm'Tftgo  +  Vf 

(2.274) 

w  = 

o 

^  +  u^tgo  +  Us  tan  xftgo  gtgo 

(2.275) 

The  states  in  the  x,  y,  and  z  directions  are  all  independent  of  each  other  as  well  as 
their  associated  controls  a^,  ay,  and  a^.  Solving  for  the  Lagrange  multipliers  in  terms 
of  the  states  yields 


3,3, 

— Q-iU  -  —a2V 
•'go  ''go 


j-asw  -  ^ 
^go  ^go 


3  3  ,3  ,  6y 

—a^u  +  -^asv  -  ^Q'4W  -  ^ 

•■go  ''go  ''go  ''go 

3,3,3  ,  -Qz  +  Zgt] 

-—a^u  -  -^a^v  + 

''go  ''go  ''go  ''go 


(2.276) 

(2.277) 


(2.278) 


where 


Oil 

=  2  —  cos^  7/  cos^  Xf 

(2.279) 

0.2 

=  sin  X/ cos  X/ cos  7/ 

(2.280) 

OiZ 

=  sin  7/  cos  7/  cos^  x/ 

(2.281) 

0:4 

=  sin  7/ sin  X/ cos  X/ 

(2.282) 

0:5 

=  1  +  cos^  Xf 

(2.283) 

016 

=  2  —  sin^  7/  cos^  Xf 

(2.284) 

Oi7 

=  2-s\n^Xf 

(2.285) 

and  the  controls  can  be  expressed  as 


where 


and 


Ol'T 


Qn 


ai 


t  I  ^2  t  ,  ^3  f 

u  H - V  +  —w 


2u 


t'go 


^go 


f'go 


^go 


Oi2  !  aj  ,  , 

- y  4-  - - 'll)  — 


2v 


dz  — 


tgo  tgo  tgo  ^go 

03  0-4  ,  06  /  2{w  +  gtgo) 

u  H - V  —  z — w  - 


t 


go 


*'90 


t 


go 


t 


go 


u  =  u  + 


3x 


*'90 


V  = 


W  = 


3y 

I'go 

Zz 

2 


9^go 


X  —  X  '^T^go 

y  =  y-yT-vrtgo 

Z  =  Z  —  Zt  —  WTtgo- 


(2.286) 

(2.287) 

(2.288) 

(2.289) 

(2.290) 

(2.291) 

(2.292) 

(2.293) 

(2.294) 


2.5.3  Solving  for  the  Final  Time 

The  transversality  condition  from  the  Pontryagin  Minimum  Principle  associated  with 
the  free  final  time  condition  (i7/  =  -Gt^)  results  in  the  following  equation 

— (a^  +  0^  +  o^)  +  Aa;ti  +  XyV  +  XzW  +  A«Ox  +  X^ay  +  A2(o^  +  £f)  =  ~Gtf  (2.295) 

where 

—Gtj  —  —T  +  UxUt  +  +  ^zWt-  (2.296) 

A  more  useful  condition  is  obtained  from  the  first  integral  (being  a  constant),  since 
the  Hamiltonian  is  independent  of  time,  which  can  be  expressed  as 
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and  after  combining  the  Hamiltonian  and  the  Bolza  function  the  following  result  can 
be  expressed 


0  =  C^tgg  +  +  C2tgo  +  Citgo  +  Co 


(2.298) 
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where 

^  ^A-sin^jfCOS^Xf  , 

O4  =  P - g  +  i 

C3  =  0 

^  cos2  xf  cos2  7;  -  4_  2  .  sin2  xf  -42,  sin2  7;  cos^  Xf  - 

C2  -  -  u  +  ^  V  +  2  "" 

3 

+b4UV  +  beUW  +  bsvw  -  -p[sin^  7/  cos^  Xf{^  “  ■^r) 

4U 

+  sin 7/ sin x/  cos x/(y  -  Vt)  +  sin 7/ sin 7/  cos^  x/(a;  -  xt)] 

—6[bjUtU  +  bsVfV  +  bgWtW  +  {uVt  +  VUT)b4  +  {vWt  +  VTw)b5 
-\-{uWx  ”l"  'ltT'^)^6]  "h  9[6iU^  +  62^^  -|-  b^W^  +  ^b^U'pVx 
+Sb5VTWT  +  ^beurwr]  +  ^{bju  +  b^v  +  b^w)uT  +  3(64^  +  b^w  +  bsv)vT 
+3{bQU  +  65U  +  bgw^WT  —  9{bfUT  +  biVx  +  b^WTjux  — 

—QipillT  +  b^VT  +  b^WT)VT  —  Sut 

—9{b6UT  +  b^VT  +  bQWT)wT  —  Qwt  (2.301) 

Cl  =  6[{b7{x  -  xt)u -\- bs{y  -  yT)v  +  bgiz  -  zt)w 

+((2/  —  2/r)w  +  (ic  —  XT)v)b4  +  {{z  —  zt)v  +  {y  —  yT)w)bs 
+{{z  —  zt)u  +  (x  —  XT)w)be]  +  9[6i(— 2x^7’  +  2xtUt) 

+b2{—2yvT  +  2yTVT)  +  bz{—2zwT  +  2ztWt) 

+3b4{—xvT  +  xtVt  —  yuT  +  yrur)  +  ^hi—ywr  +  yrWr  —  zvt  +  ztVj) 
3b6{—xwT  +  xtWt  —  zut  +  -^rwr)]  +  9[67(x  —  xt)  +  b4{y  —  yr) 

-\-b^{z  -  zt)]ut  +  6(x  -  xt)ut  +  9[64(x  -  xt)  +  b^{y  -  yr) 

+b^{z  -  zt)\vt  +  6(y  -  yT)vT  +  9[66(a;  -  Xt)  4-  65(2/  -  Vt) 

+69(2:  —  zt)\wt  +  6(2  —  zt)wt  (2.302) 

Co  =  9[bi{x“^  -  2xxt  +  Xt)  +  b2{y‘^  -  2yyT  +  yr) 

+63(2:^  -  2zzt  +  2^)  +  Sb4{xy  -  xyx  -  xt2/  +  XTyr) 

+365(2/2  -  yzT  -  Vtz  +  zryT)  +  366 (x2  -  xzt  -  xtz  +  xtZt)]-  (2.303) 


(2.299) 

(2.300) 
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Chapter  3 

The  Second  Variation  Necessary  Conditions 

In  order  establish  whether  the  proposed  guidance  laws  are  optimal  solutions  the  sec¬ 
ond  variation  necessary  conditions  must  be  satisfied.  Once  it  is  determined  that  the 
proposed  guidance  laws  satisfy  the  second  variation  necessary  conditions  it  will  then 
be  possible  to  examine  the  second  variation  sufficient  conditions  and  definitely  estab¬ 
lish  the  optimality  of  the  solution.  The  second  variation  necessary  condition  for  a 
weak  relative  minimum,  also  known  as  Legendre- Clebsch  condition,  simply  states 

Hun  >  0.  (3.1) 

The  second  variation  necessary  condition  for  a  strong  relative  minimum  is  the  Weierstrass 
condition  which  is 

H{t,x,Ui„X)  -  H{t,x,u,X)  >0  (3.2) 

where  u*  is  an  admissible  comparison  control  and  u  is  the  optimal  control.  Once  these 
two  conditions  are  met  it  is  possible  to  conclude  that  the  second  variation  necessary 
conditions  have  been  satisfied.  These  conditions  are  not  sufficient  for  a  minimum, 
but  it  is  known  that  the  optimal  path  is  not  a  maximum  [10]. 

3.1  Applying  the  Second  Variation  Necessary  Conditions 

Given  the  Hamiltonian  of  the  form 

H  =  ^{al  +  al  +  al)  +  A^tt  -t-  XyV  -t-  X^w  +  X^a^  +  X^ay  +  Aw(az  -f  g)  (3.3) 
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where 


u  = 


ay 

Qz 


(3.4) 


In  order  to  satisfy  the  Legendre-Clebsch  condition  the  second  partial  derivative  of  the 
Hamiltonian  with  respect  to  the  control  must  be  greater  than  or  equal  to  zero.  Using 
the  given  Hamiltonian  the  second  partial  derivative  of  the  Hamiltonian  with  respect 
to  the  control  is  as  follows 


1  0  0 
0  10 
0  0  1 


(3.5) 


The  identity  matrix  that  results  satisfies  the  Legendre-Clebsch  condition  for  all  four 
analytic  guidance  laws.  The  next  condition  that  must  be  satisfied  is  the  Weierstrass 
condition.  The  Weierstrass  condition  simply  states  that  the  Hamiltonian  calculated 
using  the  optimal  control  subtracted  from  the  Hamiltonian  calculated  using  an  ad¬ 
missible  comparison  control  must  be  greater  than  zero.  The  Hamiltonian  calculated 
using  the  admissible  comparison  control  is  as  follows 


Recall  from  Eqn.  2.64-2.66  that  A„  =  — Oj,  A,,  =  —tty,  and  A^,  =  — Oz.  Eqn.  2.64-2.66 
came  directly  from  the  derivation  for  the  guidance  law  considering  a  three  dimen¬ 
sional  moving  target  with  no  additional  constraints,  however,  this  condition  is  valid 
for  all  four  guidance  laws.  Using  this  knowledge  the  Hamiltonian  calculated  using 
the  optimal  control  and  the  Hamiltonian  calculated  using  the  admissible  comparison 
control  are  as  follows 


H  =  ^{al  +  al  +  al)  -h  X^u  +  XyV  +  X^w  -f  -al  -  -  a^g  (3.7) 

H*  =  +  al^  +  alj  -I-  XxU  +  XyV  +  X^w  - 


(3.8) 
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In  order  to  check  the  Weierstrass  condition  the  Hamiltonian  with  the  optimal  control 
must  be  subtracted  from  the  Hamiltonian  with  the  admissable  comparison  control. 
After  performing  the  necessary  algebra  the  results  is  as  follows 

H*-H  ^  +  i(aj,  -  +  i(a^  _  a^j2  (39) 

H*-H  >  0.  (3.10) 

Therefore  the  Weierstrass  condition  and  the  Legendre-Clebsch  condition  are  both 
satisfied,  thereby  satisfying  the  second  variation  necessary  conditions.  Again,  these 
conditions  must  be  met  in  order  for  an  optimal  solution  to  exist,  but  these  conditions 
do  not  mean  that  an  optimal  condition  has  been  found.  They  do  however  rule  out 
the  possibility  that  the  solution  is  a  maximum  [10].  This  result  applies  to  all  four 
guidance  laws. 
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Chapter  4 

Establishing  Optimality:  The  Second  Variation 

Sufficient  Conditions 

Even  with  the  guidance  laws  being  derived  using  the  first  variation  necessary  condi¬ 
tions,  the  question  must  be  raised  as  to  the  optimality  of  the  solution.  This  can  be 
verified  using  second  order  sufficient  conditions  [10].  If  a  solution  meets  the  second 
order  sufficient  conditions  then  it  is  verified  to  be  a  minimum  solution.  Given  the 
performance  index  of  the  form 

/**/ 

J^E{xf,tf)+  F{x,y,T)dT  (4.1) 

Jto 

with  a  solution  satisfying  the  Pontryagin  Minimum  Principle,  the  solution  is  a  mini¬ 
mum  if  the  following  conditions  are  satisfied 

Huu  >  0  (4.2) 

S  finite,  to  <t  <  tf  (4-3) 

where 

S  =  S-  UV-^^.  (4.4) 

The  matrices  U  and  V  are  defined  as 

U  =  R  m  (4-5) 

Q  n 


V 


a 


(4.6) 
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The  variables  S,  R,  m,  Q,  n,  and  a  are  obtained  as  solutions  to  the  following  set  of 
first  order  differential  equations 


S  =  -C-A^S-SA  +  SBS 

(4.7) 

R  =  {SB-A'^)R 

(4.8) 

m  =  (SB  -  A^)m 

(4.9) 

Q  =  R^BR 

(4.10) 

h  =  R^Bm 

(4,11) 

a  =  M^Bm 

(4.12) 

where 

-4  -  fx  fuHy^y^HuX 

(4.13) 

B  =  HuX 

(4.14) 

C  =  Hxx  BxuHy^y^  Hux 

(4.16) 

and  the  final  conditions  are  defined  as 

Sf  —  GxfXf 

(4.16) 

Rf  = 

(4.17) 

ruf  =  Qlj 

(4.18) 

II 

o 

(4.19) 

n/  =  e/ 

(4.20) 

«/  = 

(4.21) 

where 


L{t,x,  u) 

u) 


Lf  +  Gxfff  +  Gtf  —  0 

al  +  al  +  aldr 


(4.22) 

(4.23) 

(4.24) 


X, 
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If  the  conditions  on  S  and  Huu  are  met  then  the  guidance  laws  are  indeed  optimal 
solutions  of  the  given  performance  index. 

4.1  Three  Dimensional  Moving  Target 
with  no  Additional  Constraints 


In  order  to  evaluate  the  sufficient  conditions  Eqns.  4.2  and  4.3  recall  the  Hamil 
-tonian  and  Bolza  functions  are 

H  —  —  +  dy  +  a^)  +  AxW  +  \yV  +  XzW  4-  A„ax  +  Xydy 

+A^(a2  +  p)  (4.25) 

G  —  Ttf  4-  i>x[xf  —  XT  —  uritf  —  ^)]  +  J^yiVf  —  yr  —  vxitf  —  <)] 

+Vz[zf  -  zt -writf -t)].  (4.26) 


The  terminal  constraints  for  this  scenario  are  defined  to  be 

Xf  —  xt  —  uritf  —  t) 

®  =  Vf-VT-  vritf  -  t) 

Zf  —  zt  —  Wxitf  —  t) 

and  /  is  equal  to  x  with  the  following  form 

f{x,u,t)^  =  [  u  V  w  dx  dy  dz  +  g  ]^. 


(4.27) 


(4.28) 


The  first  and  second  partial  derivatives  of  the  Hamiltonian  with  respect  to  the  control 
are 


Hu 


dx 

+ 

Ay 

dy 

+ 

Ay 

ttz 

+ 

Xyj 

1 

0 

0 

0 

1 

0 

0 

0 

1 

(4.29) 


(4.30) 
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and  also  the  partial  derivative  of  the  Hamiltonian  with  respect  to  u  and  then  x  yields 

Hu.  =  03x6.  (4.31) 

Huu  is  a  constant  identity  matrix,  which  is  greater  than  zero,  and  fulfills  one  of  the 
second  variation  conditions  for  a  minimum.  The  second  partial  derivative  of  the 
Hamiltonian  with  respect  to  x  is 

=  06x6.  (4.32) 


The  partial  derivatives  of  /  with  respect  to  u  and  x  are  respectively 


0  0  0  1  0  0 
0  0  0  0  1  0 
0  0  0  0  0  1 
0  0  0  0  0  0 
0  0  0  0  0  0 
0  0  0  0  0  0 


0  0  0 
0  0  0 
0  0  0 
10  0 
0  10 
0  0  1 


Evaluating  Eqns.  4.13-4.15  using  f.,  /„,  Hum  Hux,  and  Hx.  we  get 


A 

B 

C 


f.  - 


OsxS  hx3 
03x3  03x3 


=  fJi  = 


H.x  HxuHuu  Hux 


03X3 
03x3 
=  06x6. 


03x1 

hx3 


(4.33) 


(4.34) 


(4.35) 

(4.36) 

(4.37) 
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Using  the  set  of  first  order  differential  equations  Eqns.  4.7-4.12  with  the  final  condi¬ 
tions  designated  by  Eqns.  4.16-4.21  the  solutions  S,  R,  Q,  m,  n,  and  a  can  be  found. 
The  solution  S  is  obtained  rather  simply  by  integrating  Eqn.  4.7  and  enforcing  the 
final  condition 

Sf  =  G,,.,  =  06x6  (4.38) 

such  that  the  solution  S  is 

S  =  06x6  (4.39) 

The  solution  R  is  obtained  by  integrating  Eqn.  4.8  and  applying  the  final  condition 

1  0  0 
0  1  0 
0  0  1 
0  0  0 
0  0  0 
0  0  0 

such  that  the  solution  R  is 

10  0 
0  10 
0  0  1 

tf-t  0  0 

0  tf-t  0 

0  0  tf-t 

Integrating  Eqn.  4.10  leads  to  the  solution  for  Q  by  applying  the  final  condition 

Qf  =  Osxs-  (4.42) 

The  solution  Q  is 

0  0 

0  -!(</-<)"  0  •  (4.43) 

0  0  -Wf-t)\ 


(4.41) 


(4.40) 
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The  next  solution  to  be  obtained  is  m  which  requires  the  terminal  condition  m/ 

0 
0 
0 
Vx 

Vz 

After  integrating  m  subject  to  the  final  condition  the  following  solution  is  obtained 

m  =  {SB  —  A^)m  =  —A^m  (4.45) 

0 
0 

^  .  (4.46) 

I'x 

t'y 

The  next  solution  that  must  be  obtained  is  n  and  the  terminal  conditions  for  n  are 

Uf  —  Ut 

rif  =  ef  =  Ctj  +  Cxjff  =  Vf  —  Vt  •  (4-47) 

Wf  —  Wt 

Now  enforcing  the  final  conditions  on  n  and  integrating  n  the  solution  is 

n  =  FF  Bm  (4.48) 

-  tY  +  Uf  -  Ut 

n  =  -\uy{tf —ty +  Vf  —  Vt  •  (4.49) 

_  -\^z{tf  -  ty  +  Wf-WT_ 

The  final  differential  equation  that  must  be  solved  is  a  and  the  final  condition  for  a 
is 

Q;^  —  —  ^tf  d”  ^Xf^f  —  ^x^xf  4”  ^y^yf  4~  ^z{^zf  4”  ^)*  (4.50) 


(4.44) 
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Finally  the  resulting  solution  of  a  is 


a  =  -(u^  +  +  -  i)  +  ^xdxf  +  +  q)-  (4-51) 


Using  the  solutions  of  S,  R,  m,  Q,  n,  and  a  the  matrices  V  and  U  can  be  formed 


V 


Q  n 

T 

a 


u  = 


(4.52) 

(4.53) 


In  order  to  check  the  optimality  of  a  solution  the  matrices  U  and  V  must  be  deter¬ 
mined  at  every  point  of  the  solution.  If  U  does  not  go  to  infinity  and  V  has  a  nonzero 
determinant  then  the  condition  on  S  will  be  satisfied.  Therefore,  if  these  conditions 
are  met,  the  guidance  laws  for  a  three  dimensional  moving  target  with  no  additional 
constraints  would  indeed  be  a  minimum. 


4.2  Three  Dimensional  Moving  Target 

with  a  Terminal  Flight  Path  Angle  Constraint 

In  order  to  evaluate  the  sufficient  conditions  Eqns.  4.2  and  4.3  recall  the  Hamil 
-tonian  and  Bolza  functions  are 

H  =  ^{al  +  al  +  al)  -1-  X^u  +  XyV  +  X^w  -I-  XuU^ 

-{■Xytty  -h  Xy,{ag  "h  q)  (4.54) 

G  =  Ttf -^-Uxlxf  -  XT -Uritf -t)\  +  Uy[yf -yT -Vritf -t)] 

■\-Vg\zf  -  zt  —  writf  —  t)]  +  Uilwf  —  Uf  tan  jf].  (4.55) 


The  terminal  constraints  for  this  scenario  are  defined  to  be 


Xf  —  xt  —  uritf  —  t) 
Vf-yr-  vritf  - 1) 
Zf  —  Zt  —  WT{tf  —  t) 
Wf  —  tt/tan(7/) 


(4.56) 
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and  /  is  equal  to  x  with  the  following  form 

f{x,u,t)^  =  [  u  V  w  ttx  tty  ttz  +  g  ]^.  (4-57) 

The  first  and  second  partial  derivatives  of  the  Hamiltonian  with  respect  to  the  control 
are 

Hu  =  ay  +  Xu  (4-58) 

(iz  4*  Xu) 

10  0 

Huu  =  0  10  (4.59) 

0  0  1 

and  also  the  partial  derivative  of  the  Hamiltonian  with  respect  to  u  and  then  x  yields 

i?«.=03x6.  (4.60) 

Huu  is  a  constant  identity  matrix,  which  is  greater  than  zero,  and  fulfills  one  of  the 
second  variation  conditions  for  a  minimum.  The  second  partial  derivative  of  the 
Hamiltonian  with  respect  to  x  is 


Hxx  —  OgxC. 


(4.61) 
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The  partial  derivatives  of  /  with  respect  to  u  and  x  are  respectively 


/x  = 


0  0  0  1  0  0 

0  0  0  0  1  0 

0  0  0  0  0  1 

0  0  0  0  0  0 

0  0  0  0  0  0 

0  0  0  0  0  0 

0  0  0 

0  0  0 

0  0  0 

10  0 
0  10 

0  0  1 

Evaluating  Eqns.  4.13-4.15  using  /r,  /«,  Huu^  Hux,  and  Hxx  we  get 


fu  = 


■A  —  fx  Hux  —  fx 


B 

C 


fuHuufI  =  fufu  = 


03x3  hx3 
03x3  03x3 

03x3  Osxl 
03x3  hx3 


Hxx  HxuHy^u  Hux  —  Ogxe* 


(4.62) 


(4.63) 


(4.64) 

(4.65) 

(4.66) 


Using  the  set  of  first  order  differential  equations  Eqns.  4.7-4.12  with  the  final  condi¬ 
tions  designated  by  Eqns.  4.16-4.21  the  solutions  5,  R,  Q,  m,  n,  and  a  can  be  found. 
The  solution  S  is  obtained  rather  simply  by  integrating  Eqn.  4.7  and  enforcing  the 
final  condition 

Sf  =  GxfXf  =  Oexe  (4-67) 

such  that  the  solution  S  is 


S  =  Oexe- 


(4.68) 
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The  solution  R  is  obtained  by  integrating  Eqn.  4.8  and  applying  the  final  condition 


10  0  0 

0  10  0 

0  0  1  0 

0  0  0  —  tan  7/ 

0  0  0  0 

0  0  0  1 


(4.69) 


such  that  the  solution  R  is 


R 


10  0 
0  10 
0  0  1 

tf  —  t  0  0 

0  tf-t  0 

0  0  tf-t 


0 

0 

0 

—  tan  7/ 
0 
1 


(4.70) 


Integrating  Eqn.  4.10  leads  to  the  solution  for  Q  by  applying  the  final  condition 


The  solution  Q  is 


where 


Qf  =  04x4- 


(4.71) 


Q  = 


3*' go 


2^  go 


tan  7/ 


3^  go 
0 

0 


0 

0 


3 ''go 
2'' go 


i/2 

2^  go 


tan  7/ 


2'' go 


-(H-tan^7/)<j,o 


(4.72) 


Ogo 


tf-t. 


(4.73) 
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The  next  solution  to  be  obtained  is  m  which  requires  the  terminal  condition  m/ 

0 
0 
0 

Vz 

After  integrating  m  subject  to  the  final  condition  the  following  solution  is  obtained 

m  =  {SB  —  =  -A^m  (4.75) 

0 
0 

“  .  (4.76) 

I'z  _ 

The  next  solution  that  must  be  obtained  is  n  and  the  terminal  conditions  for  n  are 

Uf  —  Ut 

nf  =  ef  =  etj  +  e^Jf  =  /  ^  (4  77) 

VJf  —  Wt 

-ta.n'Yfttxf +az^  +  g 

Now  enforcing  the  final  conditions  on  n  and  integrating  n  the  solution  is 


(4.74) 


ft 


n 


if^Bm 

-\vy{t}-tf  AVf-VT 
(Ux  tan  7/  -  Uz)tgo  -  tan  'yfUxf  +  +  5 


(4.78) 

(4.79) 
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The  final  differential  equation  that  must  be  solved  is  d  and  final  condition  for  a  is 
Oij  ~  “b  —  ^x^xf  4”  ^y^vf  4“  ^ziP'Zf  p)’  (4.80) 

Finally  the  resulting  solution  of  a  is 

a  =  -{vl  +  vl  +  vl){tf  - 1)  +  VxO-xf  +  Vyayj  + +  g).  (4.81) 

Using  the  solutions  of  S,  R,  m,  Q,  n,  and  a  the  matrices  V  and  U  can  be  formed 

y  =  ^  ”  (4.82) 

riF  a 

u  =  [r  m]-  (4.83) 

As  before,  in  order  to  check  the  optimality  of  a  solution  the  matrices  U  and  V  must 
be  determined  at  every  point  of  the  solution.  If  U  does  not  go  to  infinity  and  V  has 
a  nonzero  determinant  then  the  condition  on  S  will  be  satisfied  and  the  solution  will 
indeed  be  a  minimum. 


4.3  Three  Dimensional  Moving  Target 

with  a  Terminal  Heading  Angle  Constraint 

In  order  to  evaluate  the  sufficient  conditions  Eqns.  4.2  and  4.3  recall  the  Hamil 
-tonian  and  Bolza  functions  are 

H  =  “(o^  +  “I"  Fadx  + 

+Ati;(flz  +  5)  (4.84) 

G  =  Ttf-\-Vx[Xf-XT-UT{tf-t)]  +  ^y[yf-yT-VT{tf-t)] 

+V^[zj  -zt-  Writ/  -  t)]  +  u^[vf  -  u/tanx/]. 


(4.85) 
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The  terminal  constraints  for  this  scenario  are  defined  to  be 

Xf  —  XT  —  Uxitf  —  t) 

Vf-yr-  vritf  - 1) 

Zf  —  zt  —  writf  —  t) 

Vf  -  Uftmxf 

and  /  is  equal  to  x  with  the  following  form 

f  J  U  V  TV  dx  dy  Ojj  ”{”  Q  ]  - 

The  first  and  second  partial  derivatives  of  the  Hamiltonian  with  respect  to  the  control 
are 

dx 

Hu  =  dy  +  Xu  (4-88) 

_  02  "t"  Xyj 
10  0 

Huu  =  0  10  (4.89) 

0  0  1 

and  also  the  partial  derivative  of  the  Hamiltonian  with  respect  to  u  and  then  x  yields 

=  03x6.  (4.90) 

Huu  is  a  constant  identity  matrix,  which  is  greater  than  zero,  and  fulfills  one  of  the 
second  variation  conditions  for  a  minimum.  The  second  partial  derivative  of  the 
Hamiltonian  with  respect  to  x  is 


Hxx  —  OgxS. 


(4.91) 
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/x  = 


The  partial  derivatives  of  /  with  respect  to  u  and  x  are  respectively 

0  0  0  1  0  0 

0  0  0  0  1  0 

0  0  0  0  0  1 

0  0  0  0  0  0 

0  0  0  0  0  0 

0  0  0  0  0  0 

0  0  0 

0  0  0 

0  0  0 

10  0 
0  10 
0  0  1 

Evaluating  Eqns.  4.13-4.15  using  fx,  fu,  Huu,  H^x,  and  Hxx  we  get 


fu  = 


A  = 


fx  ^UX  —  fx 


B  =  =  fufi  = 

C  —  Hxx  HxuHjij,  H'flx  00x6. 


03x3  hx3 
03x3  03x3 

03x3  03x1 

03x3  hx3 


(4.92) 


(4.93) 


(4.94) 

(4.95) 

(4.96) 


Using  the  set  of  first  order  differential  equations  Eqns.  4.7-4.12  with  the  final  condi¬ 
tions  designated  by  Eqns.  4.16-4.21  the  solutions  S,  R,  Q,  m,  n,  and  a  can  be  found. 
The  solution  S  is  obtained  rather  simply  by  integrating  Eqn.  4.7  and  enforcing  the 
final  condition 

Sf  =  GxfXf=0^x6  (4.97) 

such  that  the  solution  S  is 


S  =  00x6 


(4.98) 
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The  solution  R  is  obtained  by  integrating  Eqn.  4.8  and  applying  the  final  condition 

10  0  0 

0  10  0 

0  0  1  0 

0  0  0  -tanx/ 

0  0  0  1 

0  0  0  0 

such  that  the  solution  R  is 

1  0  0  0 

0  10  0 

0  0  10  ,  , 

R  =  .  (4.100) 

tf-t  0  0  -tanx/ 

0  tf-t  0  1 

0  0  tf-t  0 

Integrating  Eqn.  4.10  leads  to  the  solution  for  Q  by  applying  the  final  condition 

Qf  =  04x4.  (4.101) 

The  solution  Q  is 

0  0  |*5otanx/ 

Q  —  ^  ~t^90  ^  ~2^90 

0  0  -lt%  0 

it^^tanx/  0  -(H-tan2x/)<j,o 

where 

t9o  =  tf-t.  (4.103) 
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The  next  solution  to  be  obtained  is  m  which  requires  the  terminal  condition  m/ 


= 


(4.104) 


After  integrating  m  subject  to  the  final  condition  the  following  solution  is  obtained 


m  =  {SB  -  A^)m  =  -A^m 


(4.105) 


(4.106) 


The  next  solution  that  must  be  obtained  is  n  and  the  terminal  conditions  for  n  are 


Tlf  —  Cf  —  Btj  +  ^xfff  — 


Uf  —  Ut 
Vf  —  Vt 
Wf  —  Wt 

tanxfCixf  +  “s/ 


Now  enforcing  the  final  conditions  on  n  and  integrating  n  the  solution  is 


(4.107) 


PfF  Bm 

-\vx{tf  -tY  +  Uf  -  Ut 
-^Uy{tf  -  tf  AVf-VT 
-  tY  -\-Wf-WT 

{Vx  tan  Xf  -  ^yYgo  -  tan  Xf<^xi  + 


(4.108) 


(4.109) 
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The  final  differential  equation  that  must  be  solved  is  d  and  final  condition  for  a  is 

^Xf^f  —  ^x^xf  “f*  ^y^yf  ”b  ^ziS^zj  p)*  (4.110) 

Finally  the  resulting  solution  of  a  is 

a  =  -{vl  +  +  vl){tf  -t)  +  +  Vyttyj  +  4-  g).  (4-111) 

Using  the  solutions  of  S,  R,  m,  Q,  n,  and  a  the  matrices  V  and  U  can  be  formed 

Q  n  ,  , 

V  =  (4.112) 

-nF  a 

U  =  ^  jR  m  •  (4.113) 


4.4  Three  Dimensional  Moving  Target  with  a 

Constraint  on  both  the  Terminal  Flight  Path 
Angle  and  the  Terminal  Heading  Angle 


In  order  to  evaluate  the  sufficient  conditions  Eqns.  4.2  and  4.3  recall  the  Hamil 
-tonian  and  Bolza  functions  are 

H  =  ^(Ox  +  +  XyV  +  XzW  +  Xuttx  +  Xytty 

4-Au;(az  +  g)  (4.114) 


G  =  rtf  +  Ux[Xf  —  XT  —  UT{tf  —  t)]  +  Vy\yf  —  VT  ~  ~  *)] 

+Uz[zf  -  zt  —  Writ/  -  i)]  +  i'4[wf  -  'U/tan7/] 

+i/5[w/tanx/ -'y/sin7/].  (4.115) 

The  terminal  constraints  for  this  scenario  are  defined  to  be 


Xf  —  Xt  —  Uxitf  —  t) 
Vf  —  Vt  —  Vxitf  —  t) 
Zf  —  Zt  ~  WTitf  ~  t) 
Wf  —  M/tan(7/) 
Wfi&uxf  —  VfSm')f 


(4.116) 
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and  /  is  equal  to  x  with  the  following  form 

/(x,  It,  =  [  u  V  w  ttx  ay  a^  +  g  ]^.  (4-117) 

The  first  and  second  partial  derivatives  of  the  Hamiltonian  with  respect  to  the  control 
are 

ax  “H 

Hu  =  Uy  +  Xu  (4-118) 

(tjj  “1“  Xuj 

10  0 

Huu  =  0  10  (4.119) 

0  0  1 

and  also  the  partial  derivative  of  the  Hamiltonian  with  respect  to  u  and  then  x  yields 

=  03x6-  (4.120) 

Huu  is  a  constant  identity  matrix,  which  is  greater  than  zero,  and  fulfills  one  of  the 
second  variation  conditions  for  a  minimum.  The  second  partial  derivative  of  the 
Hamiltonian  with  respect  to  x  is 


Hxx  —  OgxS- 


(4.121) 
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The  partial  derivatives  of  /  with  respect  to  u  and  x  are  respectively 

0  0  0  1  0  0 

0  0  0  0  1  0 

0  0  0  0  0  1 

fx  = 

0  0  0  0  0  0 

0  0  0  0  0  0 

0  0  0  0  0  0 

0  0  0 

0  0  0 

0  0  0 

fu  = 

10  0 
0  10 
0  0  1 

Evaluating  Eqns.  4.13-4.15  using  fx,  fu,  H^u,  Hux,  and  Hxx  we  get 


-4  -  fx  ~  fuHy^^Hy^x  -  fx  - 


03x3  h-x-Z 
03x3  03x3 


B  =  UH-ffi  =  fuft 
C 


T  _ 


03x3  03x1 

03x3  hxZ 


Hxx  HxuHy^y^  Hux  OgxS* 


(4.122) 


(4.123) 


(4.124) 

(4.125) 

(4.126) 


Using  the  set  of  first  order  differential  equations  Eqns.  4.7-4.12  with  the  final  condi¬ 
tions  designated  by  Eqns.  4.16-4.21  the  solutions  S,  R,  Q,  m,  n,  and  a  can  be  found. 
The  solution  S  is  obtained  rather  simply  by  integrating  Eqn.  4.7  and  enforcing  the 
final  condition 

Sf  =  Gxfxj  =  06X6  (4.127) 

such  that  the  solution  S  is 


S  =  06x6 


(4.128) 
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The  solution  R  is  obtained  by  integrating  Eqn.  3.8  and  applying  the  final  condition 

1  0  0  0  0 

0  10  0  0 


such  that  the  solution  R  is 


0  0  1 


0  0  0  —  tan  7/ 
0  0  0  0 


0  0  0 


—  sin  jf 

twaxf 


(4.129) 


tf  —  t 


tf-t 


-  tan  7/ 


tt  —  t 


—  sin  7/ 

tanx/ 


(4.130) 


Integrating  Eqn.  (4.10)  leads  to  the  solution  for  Q  by  applying  the  final  condition 


Qf  —  05x5- 


(4.131) 


The  solution  Q  is 


Q(1-5,1-3)  — 


3 ''go 


-if® 


2^90 


Q(1-5,4-5)  — 


|*?<,tan7/ 


-tgo{l  +  tan^  jf) 

-tgo  tanx/ 


- \tlo  tan  Xf 
-tgo  tan  Xf 
■  {sin^  jf  tan^  Xf)t9 


(4.132) 
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where 

tgo  —  tf  —  t.  (4.133) 

The  next  solution  to  be  obtained  is  m  which  requires  the  terminal  condition  rrif 

0 
0 
0 

I'x 

Vz 

After  integrating  rh  subject  to  the  final  condition  the  following  solution  is  obtained 

m  =  {SB  —  A'^)m  =  —A^m  (4.135) 

0 
0 
0 

(4.136) 

I'x 

Vz  _ 

The  next  solution  that  must  be  obtained  is  n  and  the  terminal  conditions  for  n  are 

Uf  —  UT 
Vf  —  Vt 

rif  =  Cf  =  Btf  +  Bxfff  =  Wf  —  wt  •  (4.137) 

-  tan  jfttxf  +  g 
—  sin  'jfCiyf  +  tan  X/(®z/  +  9)  \ 
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Now  enforcing  the  final  conditions  on  n  and  integrating  h  the  solution  is 


h  =  FtFBm  (4.138) 

^Uf-UT 
-l^ytlo  +  Vf-VT 

+  Wf-WT  1  •  (4-139) 

(14  tan  7/  -  VzYgo  -  dxf  tan  7/  +  +  p 

{uy  sin  7/  -  Uz  tan  X/)tso  -  sin  7/%^  +  tan  Xfi^'z/  +  9) 

The  final  differential  equation  that  must  be  solved  is  a  and  final  condition  for  a  is 


n  = 


af  =  Qf  =  Qtf  +  ^xfXf  =  i^xO-xf  +  ^yO'Vf  +  +  5)- 


(4.140) 


Finally  the  resulting  solution  of  a  is 


«  =  +  +  ^zWf  -  t)  +  l^xO-xf  +  ^yO-yj  +  Vz{o.zj  +  g)- 


(4.141) 


Using  the  solutions  of  S,  R,  m,  Q,  n,  and  a  the  matrices  V  and  U  can  be  formed 


Q  n 


riF  a 


V  = 

U  =  i?  m 


(4.142) 

(4.143) 
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Chapter  5 

Results:  Four  Optimal  Guidance  Laws 

5.1  Satisfaction  of  First  Variation  Necessary  Conditions 

Recall  from  Eqn.  2.29  the  Hamiltonian  must  be  constant  at  every  instant  in  time  and 
the  transversality  condition  must  be  equal  to  zero  for  an  optimal  solution.  Eqn.  2.29 
is  restated  below  as  a  reminder 

If  =  constant  = 

The  transversality  condition  is  the  sum  of  the  Hamiltonian  and  the  partial  derivative 
of  the  Bolza  function  with  respect  to  the  final  time.  Using  Eqn.  2.29  it  is  possible 
to  check  whether  the  four  guidance  laws  are  indeed  correct.  Since  Eqn.  2.29  is 
a  necessary  condition  for  a  minimum  it  can  be  used  to  determine  if  the  guidance 
laws  meet  this  condition.  A  simulation  was  developed  in  Matlab®  in  order  that 
given  a  set  of  initial  conditions  for  the  missile  and  the  target,  the  Hamiltonian  and 
transversality  condition  can  be  evaluated  over  time  until  the  missile  intercepts  the 
target.  Over  this  period  of  time  the  Hamiltonian,  commanded  accelerations,  Bolza 
function,  and  transversality  condition  were  computed.  Each  of  the  four  guidance  laws 
were  evaluated.  The  initial  state  of  the  missile  used  in  the  simulation  was  chosen  to 
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reflect  a  realistic  scenario  and  is  as  follows 


X 

=  -50,000  ft 

(5.1) 

y 

=  Oft 

(5.2) 

z 

=  50,000  ft 

(5.3) 

u 

=  1100  — 

(5.4) 

sec 

V 

=  0^ 

(6.5) 

sec 

w 

=  0-!^. 

sec 

(6.6) 

The  target  initial  state  was  chosen  to  exercise  all  six  components  of  the  target  state 
(which  include  a  three  dimensional  position  with  coordinates  in  all  three  axes,  and  a 
three  dimensional  velocity  vector  maneuving  the  target  in  all  three  axes).  The  target 
initial  state,  used  to  create  all  Hamiltonian  and  transversality  condition  results,  is  as 
follows 


XT  =  —5000  ft 

(5.7) 

yx  =  3000  ft 

(8.8) 

zt  =  500  ft 

(5.9) 

ut  —  — 10  — 

(5.10) 

sec 

It 

Vt  =  — 10  — 

(5.11) 

sec 

It 

wt  =  10  — . 

sec 

(5.12) 

The  results  for  the  situation  of  a  moving  target  with  no  terminal  angle  constraints  are 
shown  below.  The  Hamiltonian  is  shown  in  Figure  5.1  and  is  a  constant  value.  A  few 
seconds  before  interception  the  Hamiltonian  displays  a  sharp  curve  towards  zero  and 
then  seems  to  go  quickly  towards  negative  infinity.  The  reason  for  this  behavior  is 
that  the  guidance  laws  are  based  on  the  value  of  tgo-  As  the  current  time  approaches 
the  final  time,  tgo  approaches  zero,  the  equations  calculating  the  accelerations  of 
the  missile  divide  by  very  small  numbers  which  inevitably  approach  zero.  Since  the 
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equations  that  calculate  acceleration  must  divide  by  tgo  this  sharp  curve  at  the  end 
of  the  Hamiltonian  curve  is  expected.  In  practice,  once  tgo  gets  small  (i.e.  0.1)  it 
is  best  to  stop  calculating  acceleration  commands  and  simply  compute  the  missile 
acceleration  commands  tesed  upon  the  last  value  calculated  for  tgo.  Also  according 
to  the  previous  analysis  Eqn.  2.29,  the  transversality  condition  should  maintain 
a  constant  value  of  zero  during  the  interception.  The  transversality  condition  will 
maintain  a  constant  value  of  zero  over  all  time  because  the  derivative  of  the  Bolza 
function  with  respect  to  the  final  time,  —Gtf,  mirrors  the  Hamiltonian’s  behavior  as 
tgo  approaches  zero.  This  is  shown  in  Figure  5.2.  The  same  target  initial  state  was 
used  to  perform  a  simulation  using  the  guidance  law  that  incorporates  a  constraint 
on  the  terminal  flight  path  angle  which  in  this  scenario  is  negative  eighty-five  degrees. 
The  Hamiltonian  is  shown  in  Figure  5.3.  Again,  the  Hamiltonian  behaves  erratically 
as  tgo  moves  close  to  zero.  Also,  the  transversality  condition  maintains  a  constant 
value  of  zero  as  shown  in  Figure  5.4.  The  results  for  the  constrained  heading 


Hamiftonian  for  3D  Moving  Target 


Figure  5.1:  The  Hamiltonian  for  a  three  dimensional  moving  target  with 
no  additional  terminal  angle  constraints 


Hamiltonfan 


Figure  5.2:  The  transversality  condition  for  a  three  dimensional  moving 
target  with  no  additional  terminal  angle  constraints 


Hamfitonian  of  Flight  Path  Angle  Constraint 


Time  (sec) 


Figure  5.3:  The  Hamiltonian  for  a  three  dimensional  moving  target  with 
a  terminal  flight  path  angle  constraint  of  —85° 
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Transversatity  Condition  for  Ffigtit  Path  Angie  Constraint 


Time  (sec) 


Figure  5.4:  The  transversality  condition  for  a  three  dimensional  moving 
target  with  a  terminal  flight  path  angle  constraint  of  -85° 

angle,  which  in  this  case  is  sixty  degrees,  are  as  follows.  The  constant  Hamiltonian 
is  shown  in  Figure  5.5.  The  transversality  condition  is  shown  in  Figure  5.6.  Finally 
the  results  for  a  constrained  heading  angle  (sixty  degrees)  and  a  constrained  flight 
path  angle  (negative  eighty-five  degrees)  are  as  follows.  The  Hamiltonian  maintains  a 
constant  value  as  shown  in  Figure  5.7.  Last,  but  not  least,  the  transversality  condition 
maintains  a  constant  zero  as  shown  in  Figure  5.8. 
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Hamiftonfan  of  Heading  Angle  Constraint 


Figure  5.5:  The  Hamiltonian  resulting  for  a  three  dimensional  moving 
target  with  a  terminal  heading  angle  constraint  of  60° 


Transversaiity  Condition  for  Heading  Angie  Constraint 


Figure  5.6:  The  transversaiity  condition  for  a  three  dimensional  moving 
target  with  a  terminal  heading  angle  constraint  of  60° 
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Harnmonian  of  Flight  Path  Angle  and  Heading  Angle  Constraint 


Figure  5.7:  The  Hamiltonian  for  a  three  dimensional  moving  target  with 
terminal  flight  path  angle  of  -85°  and  terminal  heading  an¬ 
gle  constraint  of  60° 


Transversality  Condition  for  Final  Flight  Path  and  Heading  Angle 


Figure  5.8:  The  transversality  condition  for  a  three  dimensional  moving 
target  with  terminal  flight  path  angle  of  —85°  and  terminal 
heading  angle  constraint  of  60° 
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5.2  Satisfaction  of  the  Second  Variation  Conditions 

Recall  from  the  analysis  of  the  second  variation  necessary  conditions  in  Chapter  3 
that  the  second  variation  necessary  conditions  were  met  for  all  four  guidance  laws. 
In  order  to  ensure  that  the  guidance  laws  were  indeed  the  optimal  solution  it  was 
necessary  to  ensure  that  the  conditions  in  Eqn.  4.2  and  4.3  were  satisfied  (second 
variation  sufficient  conditions).  The  condition  listed  in  Eqn.  4.2  >  0  was  easily 

met  in  all  four  guidance  laws  because  the  resulting  matrix  of  is  in  fact  the 
identity  matrix  as  shown  in  Eqns.  4.30,  4.59,  4.89,  and  4.119.  Recall  that  from  the 
derivation  in  [10]  that  in  order  to  test  the  condition  on  S  represented  by  Eqn.  4.3  it 
was  necessary  to  incorporate  the  value  of  S,  R,  m,  Q,  n,  and  a  throughout  the  life  of 
the  simulation.  Using  these  solutions  it  is  possible  to  construct  the  matrices  U  and 
V  throughout  the  simulation.  In  order  to  ensure  that  S  is  always  finite  throughout 
the  life  of  the  simulation  two  conditions  must  be  satisfied.  First  of  all  the  matrix  U 
can  never  go  to  infinity.  Second  the  determinant  of  the  matrix  V  must  never  go  to 
zero  for  (t  <  tf)  thereby  making  it  noninvertible.  As  long  as  these  two  conditions 
are  met  the  second  variation  sufficient  conditions  are  satisfied.  All  four  guidance  laws 
were  tested  given  numerous  different  initial  conditions  and  the  guidance  laws  did 
indeed  satisfy  the  second  variation  sufficient  conditions.  One  of  the  tests  conducted 
used  the  same  missile  and  target  initial  conditions  that  were  used  to  conduct  the 
Hamiltonian  and  transversality  condition  tests  and  constrained  the  terminal  flight 
path  angle  to  negative  eighty-five  degrees  and  the  terminal  heading  angle  to  sixty 
degrees.  Figure  5.9  shows  the  determinant  of  the  U  matrix  over  the  flight  time  of  the 
missile.  Clearly  the  determinant  does  not  go  to  infinity  for  {t  <tf)  and  therefore  the 
matrix  will  never  be  infinity.  Again,  the  sharp  turn  to  negative  infinity  that  occurs 
at  the  final  time  is  due  to  the  fact  that  the  accelerations  are  calculated  by  dividing 
by  tgo-  As  tgo  approaches  zero  the  guidance  laws  are  essentially  dividing  by  small 
numbers  and  finally  zero.  This  behavior  occurs  in  every  test.  Figure  5.10  shows  the 
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Second  Varfation  Sufficfent  Condition  (U) 


Figure  5.9:  The  determinant  of  the  matrix  U  for  a  three  dimensional 
moving  target  with  a  terminal  flight  path  angle  constraint  of 
—85°  and  terminal  heading  angle  constraint  of  60° 

determinant  of  V  over  the  flight  time  of  the  missile.  The  figure  shows  the  determinant 
of  V  exponentially  approaching  zero.  Figure  5.11  shows  the  determinant  of  V  in  the 
final  seconds  of  testing.  In  order  to  give  a  better  perspective  of  the  behavior  of  the 
determinant  of  V  as  tgo  approaches  zero  the  exact  values  of  the  determinant  were 
also  monitored  in  order  to  check  for  zero  or  extremely  small  values.  The  determinant 
of  V  approaches  zero  as  time-to-target  approaches  zero.  Table  5.1  displays  the  last 
four  calculated  time-to-targets  and  the  four  determinants  of  V  associated  with  those 
times.  Every  determinant  prior  to  these  four  determinants  of  V  are  farther  from  zero 
than  the  first  determinant  in  the  table.  Again,  this  behavior  can  be  attributed  to 
the  fact  that  the  accelerations  are  calculated  by  dividing  by  time-to-target.  As  tgo 
approaches  zero  this  behavior  of  the  determinant  is  an  expected  result. 


Figure  5.10:  The  determinant  of  the  matrix  V  for  a  three  dimensional 
moving  target  with  a  terminal  flight  path  angle  constraint  of 
—85°  and  terminal  heading  angle  constraint  of  60° 


Second  Variation  Sufficient  Condition  (V) 


Figure  5.11:  The  determinant  of  the  matrix  V  for  a  three  dimensional 
moving  target  with  a  terminal  flight  path  angle  constraint  of 
-85°  and  terminal  heading  angle  constraint  of  60° 


tgo  (sec) 

0.30832 

0.20832 

0.10832 

0.024966 

det(y) 

-199.24 

-8.6523 

-0.046224 

-8.3761  X  10-» 

Table  5.1:  Determinant  of  V  vs.  tgo  for  a  three  dimensional  moving 
target  with  a  terminal  flight  path  angle  constraint  of  —85° 
and  a  terminal  heading  angle  constraint  of  60° 
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5.3  Comparison  with  Results  from  DIDO 

Another  method  that  was  used  to  verify  the  proposed  guidance  laws  was  to  com¬ 
pare  them  with  the  results  of  a  numerical  optimization  package.  The  DIDO/Tomlab 
optimization  tool  was  developed  at  the  Naval  Postgraduate  School  and  is  used  in 
this  thesis  to  develop  numerically  optimal  trajectories  (and  accelerations).  This  tool 
solves  the  same  problem  as  the  analytic  guidance  laws.  It  is  possible  to  compare  the 
numerical  optimal  solutions  from  DIDO  to  the  accelerations  calculated  by  the  ana¬ 
lytic  guidance  laws  to  see  if  they  agree.  The  results  from  the  analytic  guidance  laws 
were  created  using  the  same  computer  simulation  and  initial  states  that  were  used 
to  determine  if  the  Hamiltonian  was  constant  and  the  transversality  condition  was 
zero.  This  simulation  used  the  analytic  guidance  laws  to  generate  the  commanded 
accelerations  at  uniformly  distributed  points  in  time.  Figure  5.12  shows  the  com¬ 
manded  accelerations  produced  by  the  analytic  guidance  law  for  a  three  dimensional 
moving  target  with  no  angle  constraints.  Figure  5.13  shows  the  numerically  optimal 
commanded  accelerations  produced  by  DIDO.  Using  the  trajectories  calculated  by 
DIDO  and  the  Matlab®  simulation  it  was  possible  to  compare  the  commanded  accel¬ 
erations  calculated  by  these  two  methods.  Since  DIDO  doesn’t  uniformly  distribute 
its  data  points  over  constant  intervals  in  time  and  since  the  Matlab®  simulation  and 
the  DIDO  tool  have  a  different  total  number  of  data  points  (at  different  points  in 
time)  it  is  necessary  to  use  linear  interpolation  to  generate  points  along  both  curves 
at  the  same  points  in  time.  Once  these  interpolations  are  performed  it  is  possible 
to  generate  data  calculating  the  difference  in  the  commanded  accelerations  at  each 
instant  in  time.  A  sizable  portion  of  the  magnitude  of  the  calculated  differences  can 
be  attributed  to  errors  with  the  linear  interpolation  and  different  sampling  points. 
This  is  true  in  all  of  the  test  cases  using  DIDO  and  the  analytic  guidance  laws.  Figure 
5.14  displays  the  difference  in  the  two  commanded  accelerations.  The  errors  in  the 
data,  although  the  data  was  generated  using  a  linear  interpolation,  are  still  relatively 


Figure  5.12;  The  commanded  accelerations  calculated  by  the  analytic 
guidance  law  involving  a  three  dimensional  moving  target 
with  no  angle  constraints 


3D  Moving  Target  Controt  History 


Figure  5.13:  The  commanded  accelerations  found  by  DIDO  for  a  three 
dimensional  moving  target  with  no  angle  constraints 
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small  and  show  the  accuracy  of  the  analytic  three  dimensional  moving  target  guidance 
law  compared  with  the  numerically  optimal  results  generated  by  DIDO.  Additionally, 
DIDO  found  that  the  initial  time  to  target  should  be  52.2117  seconds  whereas  the 
analytic  guidance  law  found  the  initial  time  to  target  to  be  52.2096  seconds.  Figure 
5.15  displays  the  time  to  target  determined  analytically  by  the  proposed  guidance 
law  over  the  flight  path  time  of  the  missile.  Figure  5.16  shows  the  commanded  ac¬ 
celeration  numerical  results  generated  by  the  proposed  guidance  law  that  considers 
a  three  dimensional  moving  target  with  a  constraint  on  the  terminal  flight  path  an¬ 
gle.  The  constrained  terminal  flight  path  angle  is  negative  eighty-five  degrees.  Figure 
5.17  shows  the  numerically  optimized  accelerations  found  by  DIDO  for  a  three  dimen¬ 
sional  moving  target  with  a  constraint  on  the  terminal  flight  path  angle.  These  results 
match  up  extremely  well  with  the  results  found  by  the  analytic  guidance  law.  As  be¬ 
fore,  using  a  linear  interpolation  scheme  the  accelerations  from  DIDO  were  compared 


Acceferation  Errors  Comparing  DIDO  and  the  Analytic  Guidance  Law 


Figure  5.14:  The  difference  of  the  commanded  accelerations  gener¬ 
ated  by  DIDO  and  the  analytic  guidance  law  for  the 
three-dimensional  moving  target  guidance  law  with  no  an¬ 
gle  constraints 


Figure  5.15;  The  time  to  target  found  analytically  using  the  analytic  guid¬ 
ance  law  for  a  three  dimensional  moving  target  with  no  angle 
constraints 


Flight  Path  Angle  Constrained  Commanded  Acceleration 


Figure  5.16;  The  commanded  accelerations  calculated  by  the  analytic 
guidance  law  for  a  three  dimensional  moving  target  with  a 
constraint  on  the  terminal  flight  path  angle  of  —85° 
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Flight  Path  Angle  Constrained  Control  History 


Figure  5.17:  The  comanded  accelerations  found  numerically  by  DIDO  for 
a  three  dimensional  moving  target  with  a  constraint  on  the 
terminal  flight  path  angle  of  —85° 

with  the  commanded  accelerations  generated  by  the  analytic  guidance  law  and  the 
results  are  shown  in  Figure  5.18.  The  difference  between  the  two  solutions,  despite 
the  interpolation  and  distribution  of  points,  is  still  small  and  gives  strong  proof  that 
the  analytic  guidance  law  is  indeed  optimal.  The  DIDO  optimization  tool  also  found 
the  initial  time  to  target  to  be  62.5970  seconds  whereas  the  analytic  guidance  law 
found  the  intial  time  to  target  to  be  62.5806  seconds.  Figure  5.19  displays  the  time 
to  target  found  analytically  using  the  analytic  guidance  law.  Figure  5.20  displays  the 
commanded  accelerations  found  by  the  proposed  guidance  law  that  considers  a  three 
dimensional  moving  target  with  an  additional  constraint  on  the  terminal  heading  an¬ 
gle.  The  terminal  heading  angle  that  was  used  to  generate  these  results  was  sixty 
degrees.  Figure  5.21  displays  the  corresponding  numerical  results  found  by  DIDO  for 
a  three  dimensional  moving  target  with  a  constraint  on  the  terminal  heading  angle. 
The  results  found  by  the  analytic  guidance  law  and  the  DIDO  optimization  tool  are 


Acceleration  Errors  Comparing  DIDO  and  the  Analytic  Guidance  Law 


Figure  5.18:  The  difference  of  the  commanded  accelerations  gener¬ 
ated  by  DIDO  and  the  analytic  guidance  law  for  the 
three-dimensional  moving  target  guidance  law  with  a  con¬ 
straint  on  the  terminal  flight  path  angle  of  —85° 


Calculated  Time  to  Target  for  Constrained  Flight  Path  Angle 


Figure  5.19:  The  time  to  target  found  analytically  using  the  proposed 
guidance  law  for  a  three  dimensional  moving  target  with  a 
constraint  on  the  terminal  flight  path  angle  of  —85° 
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Heading  Angie  Constrained  Commanded  Acceleration 


Figure  5.20:  The  commanded  accelerations  calculated  by  the  analytic 
guidance  law  involving  a  three  dimensional  moving  target 
with  a  constraint  on  the  terminal  heading  angle  of  60° 


almost  identical.  A  linear  interpolation  was  used  to  create  comparable  points  from 
the  results  generated  by  the  DIDO  optimal  tool  and  the  Matlab®  simulation.  These 
results  are  plotted  in  Figure  5.22.  The  calculated  differences  from  the  linear  inter¬ 
polation  between  the  two  generated  results  are  small.  DIDO  found  that  the  initial 
time  to  target  should  be  62.9680  seconds  while  the  analytic  guidance  law  gave  a  time 
of  62.9683  seconds.  The  time  to  target  found  analytically  by  the  proposed  guidance 
law  is  demonstrated  in  Figure  5.23  and  the  initial  value  matches  the  result  found  by 
DIDO.  Finally,  Figure  5.24  displays  the  commanded  accelerations  found  by  the  ana¬ 
lytic  guidance  law  for  a  three  dimensional  moving  target  with  a  constraint  on  both 
the  terminal  flight  path  angle  and  the  terminal  heading  angle.  The  terminal  flight 
path  angle  enforced  is  negative  eighty-five  degrees  and  the  terminal  heading  angle  is 
sixty  degrees.  Figure  5.25  displays  the  control  history  found  by  DIDO  for  a  three 
dimensional  moving  target  with  a  constraint  on  both  the  terminal  flight  path  angle 


Heading  Angle  Constrained  Controf  History 


Figure  5.21:  The  commanded  accelerations  found  numerically  by  DIDO 
for  a  three  dimensional  moving  target  with  a  constraint  on 
the  terminal  heading  angle  of  60° 


Figure  5.22:  The  difference  of  the  commanded  accelerations  generated  by 
DIDO  and  the  analytic  guidance  law  for  a  three  dimensional 
moving  target  with  a  constraint  on  the  terminal  heading  an¬ 
gle  of  60° 


Cafculateci  Time  to  Target  for  Constiwned  Headirig  Angie 


Figure  5.23:  The  time  to  target  found  analytically  using  the  analytic  guid¬ 
ance  law  for  a  three  dimensional  moving  target  with  a  con¬ 
straint  on  the  terminal  heading  angle  of  60° 


FP  and  HA  Constrained  Commanded  Acceleration 


Figure  5.24:  The  commanded  accelerations  calculated  by  the  analytic 
guidance  law  for  a  three  dimensional  moving  target  with  a 
constraint  on  both  the  terminal  flight  path  angle  of  —85° 
and  the  terminal  heading  angle  of  60° 
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and  the  terminal  heading  angle.  Again,  using  linear  interpolation  comparable  points 
were  generated  from  the  data  created  by  the  DIDO  optimal  tool  and  the  Matlab® 
simulation  which  is  using  the  proposed  guidance  law.  Using  these  points  it  is  possible 
to  compare  the  difference  between  the  numerically  optimal  points  from  DIDO  and 
the  commanded  accelerations  generated  by  the  analytic  guidance  law.  Figure  5.26 
displays  the  differences  in  these  two  results.  Also,  Figure  5.27  displays  the  time  to 
target  found  by  the  analytic  guidance  law.  The  initial  time  to  target  found  by  DIDO 
is  88.5154  seconds  and  the  initial  time  to  target  found  by  the  analytic  guidance  law  is 
88.5439  seconds.  The  analytic  guidance  law  matches  DIDO  very  well  for  this  initial 
time  to  target. 


FP  and  HA  Constrained  Controi  History 


Figure  5.25:  The  commanded  accelerations  found  by  DIDO  for  a  three 
dimensional  moving  target  with  a  constraint  on  the  terminal 
flight  path  angle  of  -85°  and  the  terminal  heading  angle  of 
60° 


Acceferation  Errors  Comparing  DIDO  and  the  Analytic  Guidance  Law 


Figure  5.26:  The  difference  of  the  commanded  accelerations  generated  by 
DIDO  and  the  analytic  guidance  law  for  a  three  dimensional 
moving  target  with  a  constraint  on  both  the  terminal  flight 
path  angle  of  —85°  and  the  terminal  heading  angle  of  60° 


Calculated  Time  to  Target  for  FP  and  HA  Constrained 


Figure  5.27:  The  time  to  target  found  by  the  analytic  guidance  law  for  a 
three  dimensional  moving  target  with  a  constraint  on  both 
the  terminal  flight  path  angle  of  -85°  and  the  terminal  head¬ 
ing  angle  of  60° 


5.4  Evaluation  of  the  Analytic  Guidance  Laws  in  a  6-DOF 
Simulation 

In  order  to  provide  real  world  implementation  using  the  analytic  guidance  laws,  they 
were  incorporated  into  a  missile  simulation  in  Simulink/Matlab®  used  by  Draper 
Laboratory.  The  simulation  mentioned  earlier  in  the  thesis  is  a  three  dimensional 
simulation;  consequently  errors  due  to  drag  effects,  discrete  time  effects,  bang-bang 
control,  or  an  actual  missile  autopilot  which  commands  the  canards  on  the  missile 
to  achieve  certain  accelerations  were  not  incorporated.  The  six  degree  of  freedom 
simulation  incorporates  all  of  these  neglected  effects  so  that  it  provides  a  realistic 
environment  for  evaluation  of  the  analytic  guidance  laws.  The  simulation  and  its 
structure  as  implemented  in  Simulink  are  illustrated  in  Figure  5.28.  Using  this  sim¬ 
ulation  numerous  tests  were  run  to  test  the  application  and  implementation  of  the 


Seeker 


Target  Model 


Figure  5.28:  6-DOF  simulation  environment 
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analytic  guidance  laws.  The  missile 

was 

given  an  initial  condition  as 

shown  below. 
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The  target  initial  velocities  were  chosen  to  represent  movement  in  all  three  directions 
and  signify  a  vehicle  moving  at  roughly  top  speed  (roughly  60  to  70  mph).  The  target 
initial  state,  used  to  create  all  of  the  following  results,  is  as  follows 
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Figure  5.29  shows  the  relative  position  between  the  missile  and  the  target  from  the 
6-DOF  simulation  using  the  guidance  law  for  a  three  dimensional  moving  target  with 
no  angle  constraints.  Figure  5.30  shows  the  relative  position  between  the  missile  and 
the  target  from  a  simulation  using  the  guidance  law  for  a  three  dimensional  moving 
target  with  a  constraint  on  the  terminal  flight  path  angle  of  —70°.  Also,  Figure  5.31 
shows  the  flight  path  angle  history.  Clearly  from  Figure  5.31  it  is  possible  to  see  that 
the  missile  satisfied  the  terminal  flight  path  angle  constraint.  Figure  5.32  shows  the 
relative  position  between  the  missile  and  the  target  using  the  guidance  law  for  a  three 
dimensional  moving  target  with  a  constraint  on  the  terminal  heading  angle  of  30°. 


Figure  5.29:  Relative  position  between  the  missile  and  the  target  for  a 
three  dimensional  moving  target  with  no  angle  constraints 
in  the  6-DOF  simulation 


y  Constrained  Finai  Flight  Path  Angie 


Figure  5.30:  Relative  position  between  the  missile  and  the  target  for  a 
three  dimensional  moving  target  with  a  constraint  on  the 
terminal  flight  path  angle  of  —70° 


90 


Flight  Path  Angle 


Figure  5.31:  Flight  path  angle  of  the  missile  for  a  three  dimensional  mov¬ 
ing  target  with  a  constraint  on  the  terminal  flight  path  angle 
of  -70° 


Also,  Figure  5.33  shows  the  heading  angle  history.  Although  the  missile  is  extremely 
close  to  achieving  the  commanded  terminal  heading  angle  it  is  noticeably  off  by  a  few 
degrees.  This  is  due  to  the  sluggish  control  capability  of  the  missile. 


Angle  (deg)  JO  Position  (fg 


Constrained  Final  Heading  Angle 


Relative  position  between  the  missile  and  the  target  for  a 
three  dimensional  moving  target  with  a  constraint  on  the 
terminal  heading  angle  of  30° 


Heading  Angle 


Figure  5.33:  Heading  angle  of  the  missile  for  a  three  dimensional  moving 
target  with  a  constraint  on  the  terminal  heading  angle  of  30° 
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Finally,  Figure  5.34  shows  the  relative  position  between  the  missile  and  the  target 
using  the  guidance  law  for  a  three  dimensional  moving  target  with  a  constraint  on  both 
the  terminal  flight  path  angle  of  —60°  and  a  terminal  heading  angle  of  5°.  Figure  5.35 
demonstrates  the  flight  path  angle  of  the  missile  over  the  entire  simulation.  It  is  clear 
from  Figure  5.35  that  the  missile  achieves  the  terminal  flight  path  angle  constraint. 
Figure  5.36  demonstrates  the  heading  angle  of  the  missile  over  the  entire  simulation. 
The  heading  angle  overshoots  the  five  degree  mark  by  roughly  three  degrees.  As 
before,  this  can  be  attributed  to  the  sluggish  control  capability  of  the  missile. 

5.5  Results  from  the  Monte  Carlo  Analysis 

The  6-DOF  simulation  was  also  used  to  evaluate  the  family  of  analytic  guidance  laws 
in  a  Monte  Carlo  fashion.  The  quantities  that  were  varied  were  the  initial  position 


Figure  5.34:  Relative  position  between  the  missile  and  the  target  for  a 
three  dimensional  moving  target  with  both  a  terminal  flight 
path  angle  constraint  of  —60°  and  a  terminal  heading  angle 
constraint  of  5° 
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Flight  Path  Angle 


Time  (sec) 


Figure  5.35:  Flight  path  angle  of  the  missile  for  a  three  dimensional  mov¬ 
ing  target  with  a  constraint  on  the  terminal  flight  path  angle 
of  —60°  and  the  terminal  heading  angle  of  5° 


Heading  Angle 


Time  (sec) 


Figure  5.36:  Heading  angle  of  the  missile  for  a  three  dimensional  moving 
target  with  a  constraint  on  the  terminal  flight  path  angle  of 
—60°  and  the  terminal  heading  angle  of  5° 
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(altitude  and  range)  and  the  initial  roll  rate.  Using  a  standard  deviation  of  1000  ft, 
the  initial  position  (altitude  and  range)  was  varied  based  on  a  Gaussian  distribution 
with  a  mean  of  zero.  Also,  using  a  standard  deviation  of  30^,  the  initial  roll  rate 
was  varied  based  on  a  Gaussian  distribution  with  a  mean  of  zero.  The  eight  drop 
points  tested  are  shown  in  Table  5.2.  Figure  5.37  shows  the  different  drop  points  and 
their  parameters. 


Number 

Release 

Angle 

Speed 

(KTAS) 

Alt  (ft) 

Range 

(ft) 

1 

-45 

450 

8,000 

10,000 

2 

-45 

450 

12,000 

7,500 

3 

-45 

450 

20,000 

16,000 

4 

-45 

450 

20,000 

10,000 

5 

0 

450 

8,000 

22,000 

6 

0 

450 

12,000 

7 

0 

450 

20,000 

23,500 

8 

0 

450 

20,000 

29,000 

Table  5.2:  Monte  Carlo  Drop  Points 


96 


Tests  were  run  using  fifty  samples  for  each  guidance  law  from  each  of  the  eight 
drop  points.  Of  the  eight  drop  points,  point  four  is  typically  the  hardest  on  the 
guidance  law.  It  is  a  high  and  short  drop  point  and  usually  causes  the  vehicle  the 
most  trouble.  The  initial  conditions  for  the  target  are  as  follows 


XT  =  170  ft 

(5.25) 

yjt  =  0  ft 

(5.26) 

zrr  =  100  ft 

(5.27) 

ft 

%T  —  — 10 - 

(5.28) 

sec 

'IJrp  - 10  - 

(5.29) 

sec 

it 

wt  ==  10  — . 

sec 

(5.30) 

The  first  results  are  from  the  Monte  Carlo  analysis  testing  the  three  dimensional 
moving  target  guidance  law  with  no  angle  constraints.  Figure  5.38  shows  the  resulting 
confidence  interval  for  the  drop  points  one  through  eight.  Figure  5.39  shows  the 
impact  dispersions  around  the  target  for  all  eight  drop  points.  Note  the  tight  spread 
of  points  about  the  center  of  the  circle.  Although  the  plot  shows  an  exact  altitude, 
that  is  not  necessarily  the  actual  altitude  of  the  target.  Since  the  target  is  a  moving 
target  and  fifty  different  initial  conditions  are  being  tested  varied  from  eight  different 
drop  points  the  flight  time  of  the  missile  is  different  in  each  case  and  therefore  the 
altitude  of  the  target  is  also  different  in  each  case.  The  target  altitude  varies  from 
roughly  three-hundered  and  twenty  feet  to  approximately  four-hundred  and  fifty  feet 
depending  on  the  type  of  guidance  law  used  and  the  flight  time  of  the  missile.  Because 
of  the  target  motion  (horizontal  and  vertical)  the  dispersions  in  the  plot  are  due  to 
the  limitation  of  the  plotting  environment. 


Miss  Distance;  Point  1  TO  8 


Figure  5.38;  Confidence  interval  for  miss  distance  from  drop  points  one 
through  eight  for  a  three  dimensional  moving  target  with  no 
angle  constraints 


Target  Impact  Points:  Target  Alt  =0  Point  8 


XRange[ft] 


Figure  5.39:  Target  impact  dispersions  from  drop  points  one  through 
eight  for  a  three  dimensional  moving  target  with  no  angle 
constraints 
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The  next  guidance  law  tested  constrained  the  terminal  flight  path  angle  to  an 
angle  of  negative  sixty  degrees.  Again,  the  Monte  Carlo  tests  were  run  from  all  eight 
drop  points.  Figure  5.40  shows  the  confidence  interval  for  miss  distance  for  drop 
points  one  through  eight.  Figure  5.41  shows  the  impact  dispersions  around  the  target 
for  drop  points  one  through  eight.  Finally,  Figure  5.42  shows  the  confidence  interval 
for  the  terminal  flight  path  angle  considering  all  eight  drop  points.  It  is  possible  to  see 
from  these  results  that  the  missile  is  meeting  its  terminal  flight  path  angle  constraint 
very  well. 


Miss  Distance:  Point  1  TO  8 


Figure  5.40:  Confidence  interval  for  miss  distance  from  drop  points  one 
through  eight  for  a  three  dimensional  moving  target  with  a 
terminal  flight  path  angle  constraint  of  -60° 


Target  Impact  Points;  Target  Alt  =0  Point  8 


X  Range  [ft] 


Figure  5.41:  Target  impact  dispersions  around  the  target  from  drop 
points  one  through  eight  for  a  three  dimensional  moving  tar¬ 
get  with  a  terminal  flight  path  angle  constraint  of  -60° 


Flight  Path  Angle  at  Impact  Point  1  TO  8 


Figure  5.42:  Confidence  interval  for  terminal  flight  path  angle  from  drop 
points  one  through  eight  for  a  three  dimensional  moving  tar¬ 
get  with  a  terminal  flight  path  angle  constraint  of  —60° 
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The  next  guidance  law  tested  constrained  the  terminal  heading  angle  to  an  angle  of 
five  degrees.  Again,  the  Monte  Carlo  tests  were  run  from  all  eight  drop  points.  Figure 
5.43  shows  the  confidence  interval  for  miss  distance  from  drop  points  one  through 
eight.  Figure  5.44  shows  the  impact  dispersions  around  the  target  considering  all 
eight  drop  points.  Also,  Figure  5.45  shows  the  confidence  interval  for  the  terminal 
heading  angle  for  all  eight  drop  points.  Although  the  missile  is  rather  sluggish,  it  still 
does  a  good  job  of  meeting  its  terminal  heading  angle  constraint. 


Miss  Distance:  Point  1  TO  8 


Figure  5.43:  Confidence  interval  for  miss  distance  from  drop  points  one 
through  eight  for  a  three  dimensional  moving  target  with  a 
terminal  heading  angle  constraint  of  5° 
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Target  Impact  Points:  Target  Alt  =0  Point  8 


•30  Down  Range  [ft] 

XRangeftt] 


Figure  5.44:  Target  impact  dispersions  from  drop  points  one  through 
eight  for  a  three  dimensional  moving  target  with  a  termi¬ 
nal  heading  angle  constraint  of  5° 


Heading  Angle  at  Impact  Point  1  TO  8 


Figure  5.45:  Confidence  interval  for  terminal  heading  angle  from  drop 
points  one  through  eight  for  a  three  dimensional  moving  tar¬ 
get  with  a  terminal  heading  angle  constraint  of  5° 
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The  final  guidance  law  tested  constrained  the  terminal  flight  path  angle  to  an  angle 
of  negative  sixty  degrees  and  the  terminal  heading  angle  to  an  angle  of  five  degrees. 
Again,  the  Monte  Carlo  tests  were  run  from  all  eight  drop  points.  Figure  5.46  shows 
the  confidence  interval  for  miss  distance  for  all  eight  drop  points.  Figure  5.47  shows 
the  impact  dispersions  around  the  target  from  all  eight  drop  points.  Figure  5.48 
shows  the  confidence  interval  for  the  terminal  flight  path  angle  at  each  drop  point 
considering  all  eight  drop  points.  It  is  possible  to  see  from  these  results  that  the 
missile  is  meeting  its  terminal  flight  path  angle  constraint  very  well.  Finally,  Figure 
5.49  shows  the  confidence  interval  for  the  terminal  heading  angle  considering  all  eight 
drop  points.  As  expected,  the  missile  has  trouble  meeting  its  heading  angle  constraint. 


Miss  Distance:  Point  1  TO  8 


Figure  5.46:  Confidence  interval  for  miss  distance  from  drop  points  one 
through  eight  for  a  three  dimensional  moving  target  with  a 
terminal  flight  path  angle  constraint  of  —60°  and  a  terminal 
heading  angle  constraint  of  5° 
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Figure  5.47;  Target  impact  dispersions  around  the  target  from  drop 
points  one  through  eight  for  a  three  dimensional  moving  tar¬ 
get  with  a  terminal  flight  path  angle  constraint  of  —60°  and 
a  terminal  heading  angle  constraint  of  5° 


Flight  Path  Angle  at  Impact  Point  1  TO  8 


Figure  5.48:  Confldence  interval  for  terminal  flight  path  angle  from  drop 
points  one  through  eight  for  a  three  dimensional  moving  tar¬ 
get  with  a  terminal  flight  path  angle  constraint  of  —60°  and 
a  terminal  heading  angle  constraint  of  5° 
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Heading  Angle  at  Impact  Point  1  TO  8 


Figure  5.49;  Confidence  interval  for  terminal  heading  angle  from  drop 
points  one  through  eight  for  a  three  dimensional  moving  tar¬ 
get  with  a  terminal  flight  path  angle  constraint  of  —60°  and 
a  terminal  heading  angle  constraint  of  5° 
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Chapter  6 
Conclusion 

In  this  thesis  a  family  of  optimal  control  guidance  laws  were  presented.  These  optimal 
control  guidance  laws  minimize  the  commanded  acceleration  or  could  be  used  to 
minimize  the  total  flight  time  of  the  missile  depending  on  the  desire  of  the  user.  It 
was  shown  using  the  first  and  second  variation  necessary  conditions  along  with  the 
second  variation  sufficient  conditions  that  the  family  of  guidance  laws  were  minima. 
All  four  guidance  laws  were  implemented  in  a  six  degree  of  freedom  missile  simulation 
to  evaluate  their  performance.  Monte  Carlo  analysis  with  this  simulation  was  used 
to  develop  statistical  properties  of  the  missile’s  capability  to  meet  target,  flight  path 
angle,  and  heading  angle  constraints. 

In  Chapter  2,  the  first  variation  necessary  conditions  were  used  to  derive  the  four 
guidance  laws.  The  four  guidance  laws  were:  (1)  three  dimensional  moving  targets 
with  no  angle  constraints;  (2)  three  dimensional  moving  targets  with  a  terminal  flight 
path  angle  constraint;  (3)  three  dimensional  moving  targets  with  a  terminal  head¬ 
ing  angle  constraint;  and  (4)  three  dimensional  moving  targets  with  both  a  terminal 
flight  path  angle  constraint  and  a  terminal  heading  angle  constraint.  The  transver- 
sality  condition  placed  on  the  Hamiltonian  was  also  strengthened  by  testing  the  total 
derivative  of  the  Hamiltonian.  Since  the  total  derivative  of  the  Hamiltonian  of  each 
guidance  law  was  zero,  this  set  up  a  framework  to  later  test  whether  or  not  each 
guidance  law  had  been  derived  correctly. 

Chapter  3  demonstrated  that  the  family  of  guidance  laws  satisfied  the  second 
variation  necessary  conditions  for  a  minimum.  This  proved  that  the  guidance  laws 
were  not  maximums.  It  was  still  possible  that  the  guidance  laws  could  be  minima 
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or  saddle  points  and  therefore  it  was  necessary  to  proceed  to  the  second  variation 
sufficient  conditions. 

Chapter  4  established  the  optimality  of  the  family  of  guidance  laws  by  applying 
the  second  variation  sufficient  conditions.  Using  these  conditions  it  was  possible  to 
determine  that  the  family  of  analytic  guidance  laws  were  in  fact  minima. 

Chapter  5  validated  the  derived  guidance  laws  by  testing  the  Hamiltonian  of  each 
guidance  law  to  ensure  that  it  remained  constant.  The  Hamiltonian  is  constant  due 
to  the  fact  that  the  total  derivative  of  the  Hamiltonian  is  equal  to  zero  from  the 
first  variation  necessary  conditions  obtained  in  Chapter  2.  Next  the  optimality  of  the 
analytic  guidance  laws  were  established  by  applying  the  second  variation  sufficient 
conditions.  Based  on  the  second  variation  sufficient  conditions,  the  analytic  guidance 
laws  are  minima.  A  particular  test  case  was  presented  using  a  three  dimensional  mov¬ 
ing  target  guidance  law  constraining  the  terminal  flight  path  angle  and  the  terminal 
heading  angle  and  it  was  shown  that  the  second  variation  sufficient  conditions  were 
satisfied.  Next  the  commanded  accelerations  found  by  the  analytic  guidance  laws 
were  compared  with  the  commanded  accelerations  found  by  the  DIDO  optimization 
tool.  This  comparison  further  validated  the  optimality  of  the  analytic  guidance  laws 
along  with  the  fact  that  the  initial  time-to-target  found  by  DIDO  matched  the  ini¬ 
tial  time-to-target  solved  analytically  by  the  guidance  laws.  The  analytic  guidance 
laws  were  then  implemented  in  a  six  degree  of  freedom  missile  simulation  in  order 
to  test  their  performance  using  various  initial  conditions.  These  tests  proved  highly 
successful  and  led  to  a  more  in  depth  analysis  of  the  capabilities  of  the  missile  using 
the  analytic  guidance  laws  and  Monte  Carlo  analysis.  Monte  Carlo  tests  were  run  on 
each  guidance  law  varying  the  initial  position  and  velocity  of  the  missile  along  with 
the  initial  roll  rate  and  delivered  impressive  results. 

The  analytic  guidance  laws  described  in  this  thesis  have  several  benefits  to  today’s 
guidance  technology.  First  of  all  the  effects  of  gravity  are  considered  in  all  four  of 
the  analytic  guidance  laws  and  as  a  result  of  minimizing  commanded  acceleration 


107 


they  reduce  actuator  usage.  Another  benefit  of  the  analytic  guidance  laws  is  that  the 
time-to-target  is  solved  analytically  at  every  instance  in  time.  The  time  to  target  is 
an  integral  part  of  the  analytic  guidance  laws. 

The  most  important  benefit  of  the  analytic  guidance  laws  is  that  they  minimize  the 
commanded  accelerations  or  total  flight  time  depending  on  the  desire  of  the  user.  By 
minimizing  the  commanded  accelerations  it  is  possible  to  achieve  maximum  velocity 
which  comes  as  a  result  of  reducing  the  amount  of  drag.  These  new  guidance  laws 
also  give  the  missile  the  capability  to  strike  a  target  with  a  specified  flight  path  angle 
or  heading  angle  or  both.  With  the  freedom  that  these  new  guidance  laws  provide 
with  respect  to  constraining  the  terminal  flight  path  angle,  heading  angle,  or  both 
it  will  give  the  system  the  increased  capability  that  is  necessary  to  make  precision 
strikes  in  civilian  surroudings. 

In  conclusion,  the  fact  that  the  new  guidance  laws  include  the  effect  of  gravity, 
allow  for  four  different  types  of  terminal  constraints,  solve  the  time  to  target  ana¬ 
lytically  so  that  it  is  known  at  every  instant  in  time,  and  are  proven  to  be  optimal 
solutions  demonstrates  their  superior  performance  and  capability  compared  to  what 
is  currently  available  in  air-to-surface  missile  technology. 
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